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Crazepony 开 站 四 轴 飞 行走 


Crazepony 项 目 引 在 为 大 学 生 / 航 模 爱 好 者 / 创 客 提供 可 二 次 开发 的 迷你 四 轴 飞 行 器 原型 。 我 们 
秉承 开放 ， 人 合作， 分 享 的 理念 ， 致 力 将 Crazepony 打 造成 航模 爱好 者 学 习 交 流 的 软 硬 件 平台 。 
wp 包括 源 代 码 ， 原 理 图 ， 设 计 思 路 等 ， 并 且 提 供 详 尽 的 百科 
知识 库 。 可 以 通过 它 学 习 四 轴 飞 行 器 相关 知识 ， 也 可 以 在 上 面 进 行 二 次 开发 ， 实 现 自己 的 创 


= 
/ 忆 O 


网 址 : http://crazepony.com 


Wiki : http://crazepony.com/wiki.html 
博客 : http://crazepony.com/blog.html 
。 Github 站 点 : https://github.com/Crazepony 
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《Crazepony 开 源 四 轴 飞 行 器 》0.2 版 本 。 版 本 发 布 历史 : 
e。 2015-2-7 ， 第 一 次 发 布 ，0.1 版 本 。 


e。 2015-11-24 ， 第 二 次 发 布 ，0.2 版 本 。 


Crazepony 开 源 四 轴 飞 行 赴 


Crazepony 项 目 起 源 于 一 个 孩 划 从 小 对 摆脱 地 心 引 力 的 梦想 。 在 进入 大 学 之 后 
进 


个 梦想 和 自己 所 学 结合 起 来 。 到 现在 ，Crazepony 四 轴 飞 行 器 已 经 在 人 硬件 上 
改进 ， 在 软件 ， 算 法 等 方面 经 历 了 无 数 次 的 挫败 和 修改 。 


， 终 于 能 够 把 这 
行 了 10 多 次 的 
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虽然 它 还 有 很 多 的 不 足 ， 但 是 我 们 很 目 肾 的 料 它 推荐 每 一 个 朋友 。 因 为 它 代 表 看 我 们 对 梦想 
默默 的 执 看 ， 对 技术 纯粹 的 追求 ， 对 挫折 不 言 放弃 的 坚持 。 


故事 开始 


Crazepony 开 源 四 轴 飞 行 赴 


Crazepony 的 理念 


开放 ， 合 作 ， 分 享 是 Crazepony 一 站 追求 的 理念 ， 我 们 也 把 这 种 理念 带 入 到 产品 的 设计 /研发 / 
推广 中 。 所 以 我 们 把 Crazepony 开 源 ， 希 户 能 够 为 开源 硬件 /开源 软件 / 创 客 领 域 贡献 我 们 的 一 
份 力量 。 
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我 和 Crazepony 的 那 点 事 儿 (1) 


作者 : CamelGo / March 5,2014 


很 东单 ，Crazepony 的 第 一 篇 博客 是 我 来 写 ， 鉴 于 是 第 一 篇 ， 按 照 惯例 ， 我 还 是 说 点 其 他 的 
先 。 


在 中 国 目前 这 个 体制 框 染 下 ， 通 过 投机 倒 肝 发 家 致 语 的 人 太 多 ， 而 利用 上 自己 努力 学 到 的 知识 
和 工程 技巧 解决 问题 的 人 屈指 而 数 ， 少 数 人 占有 了 大 多 数 的 社会 对 是 ， 而 他 们 往往 又 是 那些 
肥 头 大 耳 ， 世 俗 圆滑 的 一 群 人 。 


当 那 些 大 型 通信 设备 垄断 两 和 房地产 老总 们 通过 资本 运作 和 干 军 万 马 的 工程 密集 型 项 目 来 聚 


断 屈 服 于 目 上 而 下 的 制度 之 中 。 而 所 谓 的 英雄 ， 仅 仅 是 这 种 企业 的 顶层 ， 莫 至 他 们 都 不 一 定 
懂得 扩 术 。 





竹 肾 国外 技术 人 员 的 纯 籽 ， 至 少 他 们 的 初 囊 不 是 为 了 圈 钱 去 做 茶 个 项 目 ， 去 干 茶 件 事情 ， 虽 
然 最 后 都 会 因此 而 便利 ， 那 是 因为 他 们 最 开始 的 不 计 后 果 和 和 奋不顾身， 让 他 们 后 来 得 以 发 现 
这 个 产品 的 市 场 和 价值 。 他 们 给 我 的 感觉 一 直 束 是 : “我 没有 其 它 上 目的， 因为 我 爱 它 ， 所 以 我 
去 做 ， 赚 不 赚钱 以 后 再 说 "也许 这 个 观点 带 有 个 人 主观 色彩 和 片面 的 地 方 ， 但 人 家 至 少 看 起 来 
是 次 某 。 

两 次 工业 时 命 的 起 源 都 在 西方 ， 而 在 我 们 这 片 神 奇 的 土地 上 ， 每 天 都 在 叫 看 创新 却 每 天 都 在 
滋生 山 案 ， 靠 大 量 重 复 的 廉价 劳动 力 去 复制 ， 我 们 习惯 了 这 种 技术 更 新 模式 ， 都 叫 它 借鉴 ， 

又 好 像 总 是 要 慢 人 家 一 个 节拍 。 照 这 种 趋势 ， 母 庸 置 疑 第 三 次 工业 革命 的 衣 芽 也 在 西方 。 

不 思 进 取 固 然 是 可 态 的 ， 然 而 缺乏 创新 的 土壤 和 原动力 ， 同 样 没有 和 希望。 说 这 话 的 时 候 ， 其 
实 自 己 心里 也 是 满 满 的 愧 妆 和 与 不 安 ， 请 接着 往 下 看 ， 心 中 黑 念 "我 只 是 借鉴 而 已 .…”。 


一 次 关于 微型 四 轴 的 演讲 


2011 年 ， 宾 夕 法 尼 亚 大 学 的 VIJAYKUMAR 教 授 在 TED 做 了 一 次 关于 四 轴 飞 行 器 的 演讲 ， 这 次 
的 飞行 器 只 有 手掌 大 小 ， 其 灵巧 程度 全 人 咋舌 ， 演 讲 大 部 分 时 间 在 科普 四 轴 飞 行 的 原理 ， 到 
最 后 教授 展示 了 他 们 飞行 器 的 应 用 ， 我 惊 呆 了 | 它们 可 以 编队 飞行 ， 多 个 飞行 器 合作 搬运 物 
体 ， 合 作 弹 奏 一 首 首 乐 ， 进 入 建筑 物 内 部 飞行 一 图 ， 然 后 对 建筑 物 内 部 空间 结构 建立 三 维 模 
型 并 上 位 机 重 构 等 。 这 是 让 我 内 心 难 以 平静 的 一 段 视频 。 


| 
怎么 能 让 它 侧 过 来 昵 





四 轴 编 队 协 作 扳 运 物体 


Cooperative Transportation 
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但 是 你 可 以 增加 载荷 承 教 量 吕 mm 和 


老 美 的 技术 已 经 发 展 到 了 例 人 发 指 的 地 步 ， 很 难 想 象 这 些 技术 要 是 被 万 悉 的 资本 主义 政府 所 
利用 ， 未 来 的 战争 将 会 是 什么 形式 ， 战 争 的 结局 又 将 是 怎样 。 





一 个 天 于 微型 四 轴 的 开源 项 目 Crazyflie 


偶然 的 机 会 ， 在 果 壳 网 看 到 了 一 个 叫 Crazyflie 的 微型 四 轴 ， 这 一 次 ， 我 的 心理 防线 被 击 得 粉 
碎 ， 因 为 它 的 开发 者 们 看 起 来 是 跟 我 们 年 龄 差不多 的 大 学 生 ， 工 作 环境 也 是 在 一 个 类 似 工 作 
宇 的 地 方 ， 并 不 像 宾 大 叫 兽 那 么 专业 。 他 们 第 一 版 飞机 是 这 样 的 ， 说 实话 ， 稳 定性 和 外 形 设 
计 不 是 那么 好 。 











| | Size: 12x12cm 
eae Flight time; 4.5min 
Ee [When no crash ;) 






这 是 他 们 2014 年 最 新 版 的 飞机 ， 较 第 一 版 好 多 了 





这 一 次 我 梓 彻 医 点燃 了 ， 深 陷 其 中 ， 难 以 目 拟 ， 从 那个 时 候 开始 谋 划 要 做 一 个 这 样 的 小 四 
轴 ， 完 成 我 曹 年 那个 对 抗 地 心 引力 的 小 小 梦想 。 


Crazepony 四 轴 荫 芽 


束 我 个 人 而 言 ， 很 喜欢 小 巧 的 电子 产品 , 那 种 抵 淮 虽 小 ,五 脏 俱全 的 感觉 简章 棒 极 了 


要 知道 ， 把 东西 做 大 很 容易 ， 要 把 东西 做 小 还 要 保证 功能 不 减 ， 这 束 需 要 耐心 和 体力 了 ， 仪 
仅 是 因为 这 样 一 个 简单 想法 ， 促 使 了 我 去 做 这 样 一 件 看 起 来 很 无 聊 的 事情 。 对 这 个 飞行 器 的 
最 初 的 构想 是 : 机 身 一 定 是 依托 PCB 板 ， 大 小 一 定 不 超过 手 营 ， 通 信 一 定 是 我 们 丈 悉 的 无 线 


解决 方案 ， 飞 行 体验 一 定 要 最 好 。 同 时 ， 兼 具 娱 乐 性 和 开发 性 ， 让 每 个 人 都 能 在 这 


年 … 


由 于 这 是 Crazepony 的 第 一 
细节 。 由 于 笔者 工程 经 a 前 期 调试 六 
能 和 各 位 一 起 探讨 ， 共 共同 进步 。 


2014 年 5 月 11 日 


篇 博客 ， 写 到 这 里 丈 钦 软 了 ， out 


过 程 中 ， 走 了 不 少 碗 路 ， 


里 找到 重 


我 和 Crazepony 的 那 点 事 儿 (2) 


作者 : CamelGo / May 29,2014 
最 近 笔 者 忙于 毕业 事 守 ,博客 没 跟 上 ... 


上 次 说 到 机 身 硬 件 融 侣 笔 了 ， 蝎 非 是 给 以 后 留 点 故事 来 写 叶 了， 好 吧 废 话 不 多 说 了 ， 和 那么 融 
开始 吧 


(一 ) 


芷 先 谈 谈 硬件 选 型 的 依据 吧 : 


主 控 方 面 : 


鲁 经 在 犹 乏 用 TI 的 430 和 系列 单片机 还 是 意 法 半 导 的 STM32。 那 是 在 我 大 二 的 时 候 ， 从 来 没有 接 
触 过 STM32， 以 前 都 是 用 51 单 片 机 和 TI 的 msp430 系 列 单 片 机 。 好 吧 ， 我 承认 了 ， 我 做 
Crazepony 其 实 是 束 是 为 了 学 习 STM32 的 ， 没 有 买 过 STM32 相 关 的 开发 板 ， 束 这 么 简单 粗暴 
大 刀 阔 径 的 开始 了 我 的 STM32 之 旅 .… 


最 终 选择 用 STM32 当 然 还 有 其 他 原因 ，TI 公 司 的 MSP430 系 列 都 是 基于 低 功 耗 在 做 文章 ， 作 
为 移动 消费 电子 ， 对 电源 续航 能 力 要 求 比较 高 的 场合 比较 适用 。 


而 意 法 半 导 的 大 部 分 单片机 都 是 ARM 架 构 体 系 下 的 Cortex 内 核 为 基础 的 单片机 ， 这 里 有 必要 
嘿 味 一 下 何谓 Cortex 架 构 : 





Crazepony 开 源 四 轴 飞 行 二 


英国 的 ARM 公 司 在 经 典 处 理 器 ARM11 染 构 之 后 ， 为 了 给 不 同 需 求 的 CPU 厂 商 提 供 服 务 ， 之 后 
的 内 核 架 构 命 名 都 改 为 Cortex， 并 分 成 了 A,R,M 三 类 ,也 即将 ARM 的 三 个 字母 拆 分 为 三 个 架构 
的 名 ， 代 表 看 不同 的 发 展 方 同 : 


。 人 系列 处 理 器 可 托管 丰富 的 OS 平台 和 位 应 用 两 提 供 全 方位 的 解决 方案 ， 诸 如 低 成 本 手 
机 、 数 字 电 视 、 机 项 盒 、 打 印 机 、 服 务 器 等 

。 R 和 有 系列 为 实时 义理 器 ， 要 求 可 靠 性 、 可 用 性 、 可 维护 性 和 实时 响应 的 散人 式 系 统 提供 解决 
方案 

。 M 系 列 是 一 系列 可 向 上 兼容 的 高 效能 、 易 于 使 用 的 义理 器 ， 这 些 义理 器 绰 在 帮助 开发 者 满 
足 将 来 对 入 式 的 需要 ， 这 些 需要 包括 低 成 本 、 不 断 增加 的 连接 、 代 码 改 善 移 植 等 。M 系 列 
主要 应 用 在 智能 测量 、 人 机 接口 设备 、 汽 车 电子 、 工 业 控 制 、 大 型 家 电 等 。 





很 显然 ， 茶 果 公 司 的 A 系列 CPU 也 是 敬 入 的 Cortex 内 核 。 


之 所 以 选择 STM32F103T8U6 作 为 Crazepony 的 主 控 必 片 。 首 先 因 为 他 是 crotex-M3 内 核 ， 继 
承 了 ARM 的 优良 性 能 ， 主 频 能 跑 到 72MHz，3 个 通用 定时 器 ，1 个 高 级 定时 器 ，7 通 道 DMA 控 
制 器 ， 而 且 总 线 接口 资源 丰富 ; 其 次 是 因为 它 VFQFPN36 的 封装 ， 只 有 6mm*6mm 的 占 地 面 
积 , 对 这 个 寸土 寸 金 的 项 目 来 说 简直 太 赞 了。 这 么 高 的 性 价 比 ， 当 然 让 我 选择 了 他 作为 主 控 。 
72MHz 虽 然 生 不 了 孩 纸 ， 但 是 足以 处 理 除 了 图 像 之 外 的 大 部 分 任务 了 。 


传感器 方面 : 


目前 Crazepony 采 用 的 是 最 常用 的 MPU6050 陀 螺 仪 加 速度 计 一 体 必 片 ， 成 本 不 超过 20 元 ， 对 
小 四 轴 来 说 ， 它 的 精度 和 性 能 绰绰有余 了 〈 当 我 听 说 教研 室 病 兄 用 的 一 颗 传 感 器 旬 片 卖 
1W+ 时 ， 我 整个 人 都 不 好 了 ..) ，MPU6050 在 这 个 价位 里 面 几乎 是 占有 绝对 的 性 价 比 优势 。 
首先 ， 它 将 陀螺 仪 和 加 速 计 整合 在 一 个 片上 ， 通 过 IC 总 线 给 出 六 个 维度 的 ADC 值 ; 其 次 ， 必 
片 本 身 提 供 一 个 “从 ?1C 接 口 ， 供 用 户 接 第 三 方 的 IC 器件， 一 般 选 择 是 接 一 个 电子 罗盘 ， 如 
HMC5883L, 构 成 一 个 9 轴 的 输出 的 姿态 模 组 ,现在 MPU9150 已 经 未 心病 狂 的 把 电子 罗盘 功能 
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整合 在 片上 了 ,但 是 要 买 60+ 元 ; 最 后 ， 这 颗 心 片 内 部 集成 了 一 个 DMP (Digital Motion 
Processor) 人 处理 器 ， 这 是 最 让 我 爱不释手 夜 不 能 法 的 一 个 功能 ,站 接 人 硬件 解 算 四 元 数 ,从 某 种 
程度 上 说 解放 了 20% 的 主 控 资 源 


数据 通信 方面 : 


数据 通信 这 块 ， 也 没什么 特别 要 考虑 的 ， 短 距离 高 速 通 信 且 免费 这 一 点 要 求 就 限制 了 只 能 选 
择 2.4GHz 这 个 频段 ， 在 这 个 频段 出 了 很 多 优秀 的 心 片 厂 丙 。 在 学 生 时 代 ， 我 用 得 最 多 是 
Nordic 公 司 的 NRF24L01 这 个 系列 的 收发 一 体 心 片 ， 由 于 刚 开 始 着 手 馈 动 Crazepony 这 个 项 目 
时 ， 我 只 会 这 颗 操 作 心 片 ， 本 着 方便 的 原则 ， 所 以 很 自然 的 选择 了 这 颗 它 (后 来 发 现 国外 一 
个 团队 bitcraze 也 用 的 这 个 系列 的 心 片 时 ， 还 是 有 点 小 激动 的 ,不 同 的 是 ，crazyfile 用 的 是 
NRF24LU1， 这 颗 心 片 在 与 USB 的 接口 上 要 容易 些 ) 


Vion Bi are TH s Cra 3 craryrad 


Crazyradio Tbls of Comants 


Fd 
村 


TH 有人 ts a 2.4 GH2 到 和 Use 及 LU ts onby Used Wo tommunicane with the Crazeflie Narna 
Duade emtar bait td ean be edorbad to wodk With a riumbrer of arrplic atiors tiat ard bassd oo fhe lowi-C est 2 4 GH2 
Chics from Nordie Somiconducter 9 


Features 

| 
* Based on thd rRF24LUT+ 吕 2.4 GHz SoC irom Nordic Semicornductor 二 
* LS8 bootloader enables firmiware uparades Wa SE 


" Ca be usedas sand-arne modyuls with RG conbolesr va empansion header, Suppots 2% PPM nput ard pomwer supoplhy, Note: There's stll ne 
Ireraars Ky supeadt Wi Bure bi ds ur donelorrmernt 


Comes with GPL frmmware developed fuly by Bacraze om datasheetl and a build ervironment that sllows you to develop YOUT Cwn frmmaara 
. Programmable via SP| wong exparnesaon header 


固 不 多 了 ， 人 硬件 已 片 选 型 大 概 是 这 样 。 下 面谈 谈 这 期 间 的 一 些 细节 


(二 ) 


一 个 处 女 座 仅仅 是 要 求 机 身上 心 片 封 艾 统一 是 QFN 有 和 错 人 么 ,不 要 再 黑 处 女 座 了 好 么 ， 他 们 活 得 
很 彩 的 。 (es ) 


机 喘 外 形 : 


如 上 一 篇 博客 谈 到 到 的 ， 我 前 前 后 后 花 了 两 年 时 间 ， 以 学 习 STM32 这 球 单 片 为 目的 开始 看 手 
一 个 完全 陌生 的 飞行 器 ， 从 硬件 到 软件 。 可 以 想象 ， 这 两 年 我 因为 无 知 所 走 的 论 路 和 男 废 挥 
的 板子 以 及 烧 挥 的 生活 费 ， 加 起 来 能 换 多 少 个 亲 包 子 和 和 侵 头 了 。 


机 身 外 形 的 设计 对 我 来 说 是 最 头 大 的 ， 一 直 想 不 到 什么 好 的 主意 ， 最 关键 的 是 我 本 人 是 天 线 
专业 的 ， 我 自以为是 的 把 2.4G 的 天 线 露 在 机 身 外 部 (如 图 1) ， 凸 显 我 是 学 过 天 线 设 计 的 男 
人 。 但 是 这 严重 破坏 了 美感 不 说 ， 还 强烈 的 刺激 了 人 处女 座 的 用 户 。 一 次 偶然 的 机 会 拆 了 一 个 
平板 电脑 ， 发 现 主板 上 有 根 长 得 很 像 电容 贴 片 电容 的 元 件 ， 百 度 后 才 发 现 ， 居 然 是 一 根 2.4G 
的 陶 首 天 线 ， 这 .... 我 这 四 年 天 线 专业 的 所 学 算是 全 部 还 给 老病 了 。 于 是 ， 后 来 再 参考 了 菜 公 
过 度 的 Crazepony 外 形 (如 图 2) 
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调试 方便 的 考虑 : 


在 第 三 版 之 前 ,我 都 是 用 的 stm32 的 SWD 接 口 烧 写 调试 固件 代码 ,这 种 方式 的 确 比较 方便 和 有 效 ， 
但 是 有 个 致命 的 弊端 就 是 需要 外 接 一 个 硕大 的 jlink 调 试 器 ,这 种 设计 简直 太 反 人 类 了 。 纠 结 了 
好 长 时 间 ， 后 来 在 看 datasheet 时 发 现 STM32 支 持 另外 一 种 下 载 模式 ， 用 串口 即 可 完成 代码 的 
下 载 ， 不 足 是 不 能 在 线 调 试 。 但 是 相 比 于 能 简化 操作 的 诱惑 ， 我 还 是 决定 在 机 身 整合 这 样 一 
个 下 载 电路 。 (如 图 ) 


这 样 一 来 ， 机 和 映 和 外 部 的 有 线 接口 束 只 有 一 根 安 卓 手机 的 标 配 数据 线 mircoUSB 线 。 它 既是 元 
电线 ， 也 是 调 参 、 烧 写 固 件 的 数据 线 。 这 对 大 妈 来 说 ， 想 必 操 作 也 是 很 简单 的 吧 





电机 驱动: 


由 于 笔者 完全 是 由 于 一 种 强烈 的 爱好 选择 了 飞行 器 ,最 开始 连 有 刷 电 机 和 无 刷 电机 的 物理 结构 
区 别 都 不 知道 , 电 调 又 是 哈 ? 傻 傻 分 不 清楚 ..… 


从 一 个 几乎 雪 基 础 的 状态 去 选择 电机 驱动 必 片 ， 穹 路 是 必须 要 走 的 ， 学 费 是 必须 要 交 的 。 鲁 
以 为 书 上 学 到 的 东西 马上 融 能 用 ， 马 上 能 转化 为 产品 ， 后 来 发 现 真 的 是 目 己 想 多 了 。 


最 开始 用 的 三 极 管 作为 电机 驱动， 采用 很 经 典 的 共 射 电路 "三极管 工作 在 开关 状态 应 该 束 行 了 
吧 ?" 画 了 用 三 极 管 驱动 的 PCB 板 ， 发 现 电 机 越 转 越 慢 ， 根 本 没劲 。 “也许 是 因为 三 极 管 红 不 了 
大 电流 ， 好 吧 那 我 换个 中 功率 管 吧 ， 集 电极 最 大 6A 电 流行 了 吧 ? "可 以 想象 结果 是 不 行 的 


首先 了 解 下 为 什么 三 极 管 作为 简单 的 电机 了 驱动 是 不 可 取 的 方案 : 


。 三 极 管 作为 一 个 古老 的 半导体 先驱 ， 它 是 以 一 个 放大 器 件 的 姿态 而 出 现 的 ， 它 在 线性 区 
域 特性 集中 ， 饱 和 和 与 截止 都 是 两 种 极端 的 工作 状态 ， 而 作为 电机 驱动 的 话 ， 我 们 只 能 选 
择 它 的 这 两 种 极端 工作 模式 

。 用 三 极 管 作 为 大 电流 负载 的 驱动 管 时 ， 不 得 不 考虑 的 是 他 自身 的 管 压 降 对 负载 的 影响 ， 
这 是 很 严重 的 。 自 身 耗 散 越 来 越 大 ， 电 机 和 管子 是 串联 关系 ， 电 池 电 压 只 有 3.7V， 电 机 
束 只 能 越 转 越 慢 了 


在 晶体 管家 族 里 面 还 有 一 种 跟 三 极 管 特性 互补 的 ， 所 有 特性 都 集中 在 开关 状态 的 晶体 壳 ， 场 
效应 管 ， 妈 MOSFET。 通 曾 的 场 效应 管 完全 导 通 时 ， 源 漏 极 电阻 都 是 mQ 级 别 的 ， 即 它 目 号 的 
耗 人 散 非 前 小 。 用 它 做 为 驱动 雪 再 合适 不 过 了 。 


最 终 选 择 了 一 个 SOT23 封 季 的 , 导 通 电压 Vgs<4v 的 场 管 (SI2302) ,结果 表现 出 了 很 好 的 驱动 


未 完 待 续 ~~ 2014/5/29 
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作者 : CamelGo / July 7,2014 
毕业 了 ,一 让 沉浸 在 离别 的 情绪 中 难以 上 自拔 


距离 上 一 篇 博客 更 新 ,已 经 快 有 一 个 月 了 ， 如 果 有 再 不 写 ， 那 么 Crazepony 很 可 能 被 怀疑 是 烂 尾 
了 ， 所 以 .. 


今天 主要 谈 谈 以 下 几 个 事情 : 


。 软件 的 整体 框 染 
。 第 4 版 的 修订 版 4.1 版 


天 于 软件 


机 里 源 代码 部 分 ， 截 止 目 前 为 止 ， 都 是 属于 一 砖 一 瓦 敲 出 来 的 裸 机 代码 。 为 了 满足 各 个 层次 
用 户 的 需求 和 体现 出 我 们 的 努力 ， 后 续 会 试 着 移植 一 个 FreeRtos 的 实时 操作 系统 内 核 ， 因 为 
bitcraze 团队 融 用 的 这 个 内 核 ， 辐 他 们 无 限 靠 近 是 我 们 的 目标 。 


那么 ， 现 在 就 结合 保 机 代码 ， 来 说 说 Crazepony 的 软件 框架 : 


学 过 51 单 片 机 的 都 知道 ， 任 何 一 个 处 理 器 要 正常 运行 后 面 的 代码 ， 首 先 必须 得 有 一 大 段 设 各 
初始 化 的 代码 先 运 行 ， 这 些 代 码 用 于 初始 化 处 理 器 的 内 部 时 钟 、 中 断 优 先 级 、1/O 口 的 输入 输 
出 方 同 等 等 ， 也 束 是 为 后 续 代 码 正 党 运行， 做 了 一 个 环境 配置 准 各 。 


Crazepony 的 主 控 是 Crotex-M3 内 核 ， 其 实 就 是 ARM 架 构 发 展 到 一 定 阶 段 的 产物 ， 那 是 什么 
呢 ? 还 是 ARM 架 构 。 于 是 ， 对 ARM 的 初始 化 ， 首 先 必 须要 做 的 就 是 系统 时 钟 初 始 化 ， 中 断 向 
量 表 初始 化 ， 中 断 优先 级 初始 化 ，1JO 方 向 初始 化 ， 如 下 : 


了 


功能 : 


1. 初 始 化 各 个 硬件 
>. 初始 化 系统 参数 汪 
3. 开 定时 器 4 等 待 数据 中 断 到 来 
4. 开 定时 器 3 种 口 广播 实时 姿态 以 及 相关 信息 


int mainlvoid) 


i 
/Systemclock HSE(7); /7 系统 时 钟 初 始 化 ， 时 钟 源 外 部 晶振 HSE 
SystemCclock HSILI91) : 7 了 季 统 时钟 初 始 化 ， 时 钟 源 内 部 HSI 
UART1 init {SysClock,115200); // 串 口 1 初始 化 
NVIC INIT'(); /7 中 断 初 始 化 
STMEFIRSH Unlock(); /内 部 flash 解 负 
LedInit (): AVI 初始化 
delay init {SvsClock); /1 泣 党 延 时 初始 化 
BT PowerInit!{); /7 昔 牙 电源 初始 化 完成 ， 各 认 天 团 
MotOFInit 1》 : /7 马达 初始 化 
BatteryCcheckIniti{).; A 电池 电压 监测 初始 体 
TIC Init(): /7IIC 初 始 化 
MPU6050 DMP Initialize(); A 初始 化 pMP 引 擎 
PID INIT1) : /7EID 参 数 初 始 化 
ParameterReadil).: /fF1lash 登 数 庄 取 
NREF24L01 INITI): /ANRF24L01 初 始 化 
SetRX Mode () ; /1/ 设 无 线 模 块 为 接收 模式 
/i Poweron!l): 上 7 开机 等 待 
BT onl): 11 昔 和 牙 开 
TIM3 Init(SysCLocKk, 50) ; 7 定时 器 3 官 始 化 ， 调 试 串口 输出 
TIM4 Init{SysClock,1000); /7 定时 器 4 韦 冶 化， 定时 采样 忧 司 器 煞 据 ， 更 新 BID 和 输出 
while {1); /7 等 待 数据 更 新 中 断 到 来 


入 
J 


然后 ，STM32 内 部 模拟 EEPROM 初始 化 ; 然后 ，LED 初 始 化 ; 然后 ， 延 时 函数 初始 化 ; 然后 
， 蓝 牙 电 源 使 能 初始 化 ; 然后 ， 电 机 PWM 输出 初始 化 ; 然后 ， 电 池 电 压 AD 初 始 化 ; IC 总 线 
初始 化 ， 传 感 器 初始 化 ，PID 参 数 初 始 化 ， 无 线 收发 模块 初始 化 为 接受 模式 ， 开 蓝牙 ， 开 有 定 
时 器 3， 开 定时 器 4。 


初始 化 看 起 来 很 繁杂 ， 很 多 ， 也 没 啥 好 说 的 。 现 在 谈 谈 Crazepony 是 怎么 正常 飞 起 来 的 : 
前 面 已 经 努力 的 初始 化 了 一 大 堆 东 西 了 ， 那 么 飞机 起 飞 所 需 设备 以 及 环境 也 正常 了 ， 
Crazepony 接 下 来 需要 做 的 最 重要 事情 ， 就 是 如 何 去 合 理 的 控制 这 些 设 备 ， 让 飞机 正常 起 飞 
飞机 起 飞 所 需要 的 必须 设备 就 是 : 电机 + 螺旋 桨 + 姿态 传感器 。 


在 这 里 ， 我 们 必须 承认 的 一 点 就 是 ， 四 路 PWM 信号 的 占 空 比 大 小 ， 线 性 的 代表 了 电机 转速 快 
慢 ， 也 即 线 性 代表 了 电机 上 提供 的 升力 。 于 是 ，Crazepony 现 在 只 需要 控制 单片机 内 部 定时 器 
准确 的 输出 四 路 PWM 信 号 就 行 了 ， 其 他 的 事情 ， 交 给 执行 机 构 : 电机 + 螺旋 浆 去 完成 。 
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接 下 来 ， 程 序 运行 到 死 循 环 while (1) ; 程序 会 一 直 俘 在 这 里 ,等 竺 数据 中 断 的 到 来 ， 而 不 是 
死机 死 在 这 里 ， 这 是 有 区 别 的 ， 学 过 51 的 人 都 知道 ， 我 不 在 多 说 。 


在 初始 化 代码 段 ， 我 们 说 到 初始 化 了 两 个 定时 器 ， 一 个 定时 器 3， 一 个 定时 器 4， 这 两 个 定时 

器 都 可 以 打 断 死 循 环 while (1) 。 定 时 器 3 用 于 广播 机 身 姿态 信息 ， 定 时 器 4 的 任务 要 繁重 得 

多 ， 用 于 更 新 遥控 效 据 + 机 喘 安 态 融 合 +PID 计 算 输 出 +PWM 输 出 。 (关于 PID 和 姿态 融合 部 分 
的 细节 http://www.crazepony.com/wiki.html ) 可 以 看 到 ， 定 时 器 4 里 面 任务 的 优先 级 明显 要 比 
定时 器 3 实时 性 要 求 更 高 ， 所 以 。 中 断 优 先 级 的 顺序 是 : 定时 器 4 > 串口 中 断 > 定时 器 3。 姿 

态 更 新 频率 为 1000Hz， 广 播 信息 更 新 频率 为 1Hz。 


1000Hz 的 数据 更 新 频率 ,已 经 足够 承受 Crazepony 反 应 了 , 阿 莫 上 有 人 说 几 百 赫 益 是 最 佳 。 
实 ， 这 舌 不 多 了 多 少 。 学 信号 的 人 都 知道 ， 采 样 间隔 越 小 ， 对 信号 的 还 原 越 精 确 ， 所 以 ， 我 
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打开 康 件 | 硫 御 | 信 目 发放“ 扩展 | 厂 RTS 


串口 号 [comz | 才 打开 串口 | ”帮助 | 保存 窗口 | 清除 窗口 | 厂 EX 显示 上 ?Th 


: 直 特 挛 |9600 ”| 厂 定时 发 送 |100 ms 次 三 发 送 新 科 大 是 过 二 网 

数据 位 13 r| 字符 申 输 入 框 : | 了 EX 发 送 
TT—— 
www.daxia.cor |5:0 R:4941 COM2 已 关闭 9600bps 8/CTS=0 DSR=0 RLSD=0 


综 上 ， 有 点 乱 ， 但 是 我 们 缕 一 绑 。 很 简单 ， 只 有 3 个 中 断 。 定 时 器 4 是 核心 中 断 ， 所 有 的 算法 
都 是 在 这 里 实现 的 ， 机 映 的 稳定 也 是 靠 这 个 中 断 来 实现 的 


大 概 的 框 以 融 是 这 样 ,实现 的 细节 ， 源 码 里 面 都 有 注释 ， 写 得 很 浅显 易 懂 


关于 第 四 版 的 修 ; 


人 第 四 版 料 会 是 最 终 版 ， 不 会 再 改 了 。 但 是 鉴于 嘉 利 创 工艺 的 问题 ， 我 还 是 得 做 
4.1 版 。 这 里 不 吐槽 嘉 利 创 了 ， 大 家 都 不 容易 ~~ 
说 说 4.1 版 的 特性 吧 : 


。 最 明显 的 一 个 特性 就 是 省 略 了 实体 遥控 ， 改 用 安 章 app 客 户 端 来 控制 Crazepony， 直 接 用 
手机 的 姿态 去 控制 Crazepony 的 姿态 ， 屏 幕 上 只 有 一 个 油门 键 ， 没 有 方向 键 ， 界 面 如 
下 : 


+* 
N Roll - 


(如下 午 03:35 
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OO 
轩 
> 
= 
OO 
OO. 
© 
N 
© 
一 
OO 
扩 
过 
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0.00K/S 慷 





;由 | j: 
590 


Roll+ 





只 能 拨打 紧急 呼救 电 .. 


。 其 次 就 是 ，Crazepony 也 有 了 类 似 地 面 站 的 东西 ， 目 前 正在 开发 中 ..…. 


维 于 态 明 示 ROT PIT: TAY 





























通 近 数据 接收 
| 油门 当前 : 时 
| 机 A 1 全 十 六 进 制 显示 〇 字符 串 显示 《请 全 》 《保存 ) 
串口 设置 
数据 发 送 
囊 口 ”|coul 间 波 特 率 [s600 同一 3 
打开 串口 . | 
奇偶 校 验 无 校 验 于 数据 位 8 | (站 手 符 事 发 这 人 门 16 进 制 发 送 。 《 发送 数 据 》 
控制 面板 
Static 
油门 控制 ( 左右 方向 键 调整 ) : 电机 占 空 比 : FID 周 节 : 
0 Roll ?: | [EX 本 
电机 1 : 0% 电机 2 : 0 
mr ?| | | | ] 
| 一 键 停 飞 em: | 0% 电机 4 : | 0% xz PP: | | I: | | 5: | | 


( 读 取 参数 ) ( 保存 参数 ) 


e。 便 件 方面 ， 增 加 了 电子 罗盘 HMC5883L 

e。 增加 了 电机 保护 套 ， 调 试 阶段 ， 电 机 屁股 经 党 被 戳穿 ， 这 个 保护 套 是 很 有 必要 的 

e。 机 身 所 有 焊 毅 全 部 采用 沉 金 工艺 ， 阻 容 元 件 全 部 采用 0402 封 装 ， 且 全 部 工厂 贴 片 加 工 ， 
布局 合理 





最 后 ， 有 必要 说 下 ，4.1 版 ， 我 们 目前 正在 加 班 熬 夜 完善 ， 争 取 在 9 月 初 公 布 购买 链接 


Crazepony 四 轴 交 流 群 : 346226561 


~~~~ 未 完 待 续 2014/7/7 


人 手 试 飞 教程 


作者 : nieyong 本 教程 适合 Crazepony 5.2，5.1 版 本 


整 机 物料 列表 


。 Crazepony 四 轴 飞 行 器 ， 电 机 / 桨 叶 已 经 安 锋 (1 个 ) 
。 Crazepony 过 挥 器 ， 摇 杆 / 授 杆 帽 已 经 安 狐 (1 个 ) 
。 各 用 电机 2 个 


确认 飞机 的 前 与 后 
Crazepony 软 认 固 件 使 用 是 的 X 结 构 模 式 ， 无 头 飞行 模式 ， 遥 控 软 认 国 件 为 左手 油门 〈 美 国 
手 ) 。 


将 飞机 水 平 放 于 地 面 ， 在 飞机 正中 间 ， 有 箭头 指向 飞机 的 正 前 方 〈 飞 机 的 开关 方向 ) 。 除 此 
之 外 ， 还 可 以 通过 机 名 确认 前 后 。M3 和 M4 机 名 为 飞机 机 头 方 向 ，M1 和 M2 为 飞机 机 尾 方 向 。 





人 





一 般 我 们 站 在 飞机 的 后 方 ， 面 向 飞机 开始 操控 。 


Crazepony 遥 控 默 认 固件 为 美国 手 ， 无 头 模式 。 更 多 天 于 遥控 回 美 国手 。 更 多 关于 无 头 
模式 飞行 。 


过 控 絮 操作 


将 遥控 器 开关 推 到 ON。 

将 飞机 的 开关 推 到 ON， 飞 控 开始 初始 化 ， 大 概 需 要 10 秒 左右 。 最 后 如 果 M1 和 M2 机 和 辟 
个 LED 闪 烁 ， 则 可 以 进入 下 面 的 解锁 试飞 。 否 则 ， 请 进入 异常 处 理 部 分 ， 具 体 查看 下 面 
的 Crazepony 灯 语 部 分 。 

解锁 试飞 。 左 手 油 门 低 到 最 低 同 时 右手 横 滚 拉 到 最 左边 ， 解 锁 油门 。 解 锁 成 功 ， 飞 机 电 
机 将 和 怠速 旋转 。 《最 新 版 本 遥控 固件 不 再 需要 该 步骤) 

。 按 下 腺 控 器 上 “-” 按 键 ，M1 和 M2 机 辟 上 LED 常 亮 进 入 校准 。 校 准 结束 ，M1 和 M2 机 辟 上 


LED 开 始 闪 烁 。 按 下 双 控 器 上 的 “+” 按键 ， 开 启 电 机 蕊 速 转动 。 

。 默认 是 定局 飞行 模式 ， 油 门 通 者 控制 垂下 方向 的 速度 ， 缓 慢 推油 门 ， 四 轴 将 开始 上 升 ， 
拉 到 油门 中 位 以 下 则 下 降 。 

。 降落 操作 ， 可 以 使 四 轴 下 降 至 地 面 ， 然 后 ， 按 "+" 号 键 天 闭 电机 。 


默认 飞行 模式 为 无 头 、 定 高 飞行 模式 。 飞 机 记录 起 飞 的 方向 ， 飞 行 过 程 中 ， 飞 机 响应 所 
杆 的 方向 ， 始 终 以 起 飞 时 的 方向 为 准 ， 没 有 机 头 机 尾 的 区 别 。 


下 面 为 遥控 器 解锁 操作 示意 图 。 


过 探 和 解锁 动作 示意 图 
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下 面 为 过 控 器 上 按键 功能 标注 。 


国画 











手机 APP 迁 控 - 蓝 牙 4.0 BLE 


Android 手 机 需要 Android 4.3 版 本 以 上 。 


官网 下 载 支 持 BLE 的 Android APP， 并 且 安 装 。 另外 ， 因 蓝牙 版 本 的 设计 及 本 批 次 选用 扭力 稍 
大 于 之 前 版 本 的 720 空 心 杯 电机 ， 我 们 修改 了 基 停 两 处 参数 ， 最 新 有 版 适用 于 蓝牙 4.0 机 身 、 遥 
控 固 件 下 载 链接 。 


蓝牙 4.0 版 本 APP 使 用 方法 


。 将 飞机 的 开关 推 到 ON，LED 开 始 进 入 一 系列 的 闪烁 变化 ， 飞 控 开 始 初 始 化 。 

。 打开 APP， 点 击 连接 。 

。 查找 设备 ， 会 搜寻 到 名 字 为 Crazepony 设 备 。 上 点 击 连接 此 设备 ， 无 需 配对 ， 无 需 PIN 码 ， 
连接 成 功 后 ， 机 身 的 蓝牙 提示 灯 常 亮 。 


。 氮 击 校准 按钮 ， 此 时 M1 和 M2 和 臂 上 的 led 灯 会 单元 ， 校 准 陀螺 仪 和 加 速度 计 ， 校 准 完成 后 
开始 闪烁 ， 等 竺 解锁。 

。 氮 击 定 局 按钮 。 

。 扣 击 解锁 按钮 ， 四 个 电机 肪 速 施 转 ， 推 动 油门 ， 飞 机 起 飞 ， 松 开 油门 ， 飞 机 姑 停 。 

。 扩 击 起 飞 /降落 按键 ， 可 以 手动 降 党 飞机 (起 飞 按键 目前 不 支持 此 功能 ， 降 落 按键 有 功 


能 ) 。 
注意 : 用 app 操 作 时 ， 飞 行 模式 需要 手动 设置 ， 即 需要 点 定 高 和 无 头 才 能 实现 相应 的 功能 。 


听 控 和 app 控 制 ， 都 支持 失控 自动 降落 功能 ， 控 制 距离 建议 不 要 大 于 20 米 ， 最 好 在 宇内 练习 熟 
练 以 后 再 去 军 外 飞 。 


Crazepony 


| 用: | | i 











iPhone 手 机 APP 很 快 就 可 以 发 布 。 


手机 APP 壮 控 - 蓝 牙 2.1 


蓝牙 2.1 版 本 现在 已 经 停产 ， 现 在 文 持 蓝 牙 4.0 BLE。 
官网 下 载 支 持 蓝 牙 2.1 版 本 的 APP， 并 且 安 装 。 


。 将 飞机 的 开关 推 到 ON，LED 开 始 进 入 一 系列 的 闪烁 变化 ， 飞 控 开 始 初 始 化 。 

。 打开 app， 点 击 连 接 。 

e。 查找 设 务 ， 第 一 次 连接 crazepony， 设 备 名 是 一 个 叫 null 的 设 各 ， 点 击 连 接 此 设备 ， 会 显 
示 出 完整 设 各 名 : crazepony，PIN 码 为 : 1234， 连 接 成 功 后 ， 机 身 的 蓝牙 提示 灯 常 亮 。 

。 点 击 校 准 按 钮 ， 此 时 M1 和 M2 辟 上 的 led 灯 会 常 亮 ， 校 准 陀 曙 仪 和 加 速度 计 ， 校 准 完成 后 
开始 闪烁 ， 等 符 解 锁 。 

。 点 击 定 高 按钮 。 

。 点 击 解 锁 按 钮 ， 四 个 电机 已 速 旋 转 ， 推 动 油门 ， 飞 机 起 飞 ， 松 开 油 门 ， 飞 机 姑 停 。 

。 点 击 起 飞 /降落 按键 ， 可 以 手动 降落 飞机 (起 飞 按 键 目 前 不 支持 此 功能 ， 降 落 按键 有 功 


能 ) 。 
注意 : 用 app 操 作 时 ， 飞 行 模式 需要 手动 设置 ， 即 需要 点 定 高 和 无 头 才 能 实现 相应 的 功能 。 


听 控 和 app 控 制 ， 都 支持 失控 自动 降落 功能 ， 控 制 距离 建议 不 要 大 于 20 米 ， 最 好 在 宇内 练习 训 
练 以 后 再 去 军 外 飞 。 


Crazepony 灯 话 


Crazepony 的 4 个 各 膀 各 有 一 个 蓝 色 的 LED。 我 们 规定 了 部 分 LED 闪 烁 的 方式 〈 灯 语 ) ， 用 于 
指示 飞机 的 状态 。 灯 语 分 为 指示 类 型 和 异常 类 型 ， 指 示 类 型 用 于 开发 和 调试 ， 异 常 类 型 则 必 
须要 义理 才能 够 使 用 飞机 。 


异常 指示 灯 列 表 。 


| 灯 语 | 含义 | 解决 办 法 | | 旋转 闪烁 | 未 接收 到 遥控 信号 〈 遥 控 或 者 手机 APP) | 开启 芭 控 器 。 如 果 
开启 如 控 器 未 能 解决 ， 则 需要 先 开启 未 控 器 ， 再 开启 飞机 重 试 ( 重 烧 固件 时 会 遇 到 ) | |IM1 M2 
和 M3 M4 交替 闪烁 |IMU 未 校准 | 将 飞机 水 平 放置 地 面 上 ， 按 冯 控 器 上 “-" 号 键 (或 者 APP 上 的 校 
准 按钮 ) 进行 IMU 校 准 | 4 灯 同 时 快 闪 | 低 电 压 提 示 | 给 电池 死 电 | 


正常 提示 灯 列 表 。 


| 灯 语 | 含义 | IM1 和 M2 常 亮 3 秒 ，M3 和 M4 长 灭 |IMU 启动 校准 ， 校 准 陀螺 仪 | IM1 和 M2 闪烁 ，M3 
和 M4 长 灭 | 正常 ， 可 以 进行 起 飞 ，IMU 校 准 等 动作 | IM1 闪 烁 8 次 ， 其 它 灯 长 灭 | 配置 蓝牙 模块 | 





口 





Crazepony 开 赣 四 轴 飞 行 召 


关于 蓝牙 配置 : 机 身 的 M1 避 上 的 LED 灯 会 闪烁 8 次 ， 这 里 是 在 检测 蓝牙 模块 是 否 正 汕 ; 
如 果 蓝 牙 设 各 波 特 率 不 是 设 定 值 (115200) ， 那 么 会 进入 写 蓝 牙 设 各 名 ， 写 波 特 率 ， 写 
PIN 码 的 逮 辑 ，M1,M3 和 M2，M4 尼 上 的 灯会 交 共 闪烁， 配置 蓝牙 参数 成 功 后 ， 四 个 灯 一 
起 点 腕 1 秒 


电量 检测 和 充电 


飞机 的 四 个 机 辟 LED 同 时 出 现 快速 闪烁 ， 则 表示 飞机 电池 需要 充电 。 将 飞机 开关 找到 Charge 
位 证 ， 连 上 usb 线 则 可 以 充电 。 可 以 使 用 电脑 ， 充 电 宝 ， 手 机 充电 器 等 为 飞机 进行 充电 。 





充电 时 红色 LED 腕 起 ， 变 上 暗 或 者 灭 挥 的 时 候 则 表示 充电 完成 。 


电机 容易 损坏 的 问题 


为 什么 Crazepony 的 电机 臂 部 老 是 被 戳穿 ? 有 人 会 在 这 个 时 候 开 始 一 个 描 儿 乱 喷 吕 女 ， 我 也 很 
无 奈 。 


入 手 试飞 指导 31 


这 么 说 吧 ， 正 常情 况 下 100 次 起 落 ， 都 不 会 对 飞机 造成 任何 物理 结构 上 不 可 逆 的 毁 十。 那么 ， 
电机 臂 部 被 惟 穿 这 种 事情 ， 属 于 飞机 脸 先 着 地 的 意外 ， 他 的 臂 部 是 被 那 根 轴 项 穿 的 ， 空 心 杯 
电机 其 实 很 脆弱 ， 这 个 我 没 办 法 控制 ， 我 已 经 尽力 了 。 我 看 了 国内 的 那些 用 空心 杯 电 机 的 小 
四 轴 ， 好 像 都 有 这 个 问题 .所 以 ， 大 家 提高 飞行 技术 ， 是 对 Crazepony 最 下 接 的 保护 。 当 然 ， 
电机 坏 了 ， 这 种 事情 太 好 人 处理 了 ， 多 准 各 些 空心 杯 电 机 ， 只 要 主板 没 坏 ， 随 便 怎 么 折腾 都 可 
以 ... 


奖 叶 / 通 皖 安 猜 


对 于 Crazepony 5.2 版 本 ， 人 手 即 飞 ， 不 需要 该 步骤 的 安 委 。 


四 轴 飞 行 器 的 浆 叶 分 为 两 种 ， 正 桨 和 反 桨 。 安 装 的 时 候 不 能 够 搞 混 淆 。 桨 叶 上 标示 有 R 的 安装 
到 M2，M4 两 个 机 臂 的 电机 上 。 标示 有 L 浆 叶 安 装 到 M1，M3 两 个 机 臂 电 机 上 。 





发 货 清单 中 有 黑色 和 透明 两 种 硅胶 元 ， 用 于 缓冲 飞机 降 沙 时 的 撞击 ， 并 且 起 到 保护 电机 线 的 
作用 ， 请 目 行 选择 一 种 安 委 。 效 果 如 下 图 所 示 。 





你 拿 到 Crazepony 的 包 应 的 时 候 ， 需 要 目 行 安 交 遥控 器 摇 杆 帽 ， 没 有 雹 右 之 分 。 


将 2.4G 模 块 安装 到 遥控 器 上 的 排 针 插 座 上 。 模 块 方向 向 外 。 


散 件 组 装 教程 


作者 : nieyong 本 教程 适合 Crazepony 5.2，5.1 版 本 


从 5.1 版 本 开始 ，Crazepony 不 再 提供 散 件 销售 。 本 组 闻 教 程 主要 目的 是 提供 给 后 期 的 维修 和 
改装 。 


物料 列表 


。 Crazepony 主 控 电 路 板 (PCBA) 
。 720 空 心 杯 有 刷 电 机 

e。 75mm 正 反 浆 叶 

。 有 有 刷 电 机 套 

e。 Crazepony 遥 控 器 主 控 板 (PCBA) 
。 380mAh 航 模 电 池 

。 摇 杆 巾 

e 遥控 器 用 2.4G 无 线 模 块 (1 个 ) 
蓝牙 透 传 模块 HM-06 (1 个 ) 


PCBA 是 英文 Printed Circuit Board (PCB) + Assembly 的 简称 ， 也 就 是 说 PCB 空 板 经 过 
SMT 贴 片上 件 ， 再 经 过 DIP 揪 件 ， 最 后 得 到 的 元 器 件 已 经 贴 好 的 电路 板 ， 简 称 PCBA。 


需要 电 烙 铁 ， 螺 丝 刀 ， 剪 刀 (或 者 小 刀 ) 等 工具 ， 需 要 有 一 定 的 DIY 能 力 。 


电子 软件 部 分 测试 


Crazepony 主 控 电 路 板 / 帝 控 器 电路 板 已 经 烧 入 了 最 新 版 本 的 代码 ， 并 且 进 行 了 测试 。 用 户 拿 
到 之 后 可 以 通过 以 下 方式 对 其 基本 功能 进行 测试 ， 人 确保 正确 。 


todo 


电机 安 委 


将 电机 插入 电机 又 内 ， 电 机 供电 线 从 电机 套 底部 留 出 。 注 意 电 机 一 十 要 完全 插入 底部 ， 不 要 
留 有 空 除 。 否 者 ， 电 机 套 保护 电机 压 部 免 受挫 军 的 作用 融 没 有 了 。 
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将 电机 供电 线 扭转 成 及 花 状 ， 留 足 到 电机 焊 盘 长 度 ， 勇 去 多 余部 分 ， 最 后 将 电机 线 焊 搂 到 焊 
盘 上 。 电 机 的 焊接 ， 对 应 原则 是 ， 将 黑 线 焊接 到 标示 有 + 的 焊 盘 ， 日 线 焊 接 到 另外 一 个 焊 盘 。 


将 电机 露出 电机 套 部 分 插入 飞 控 电路 板 的 电机 孔 中 。 这 次 的 电机 孔 刚 好 能 够 卡 住 整个 电机 。 






在 发 货 清 单 中 提供 有 2M 螺 丝 和 垫 片 ， 用 于 固定 电机 和 电机 套 。 


组 委 维 修 指导 
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将 电机 套 故 邵 开 一 个 缺口 ， 将 电机 线 从 这 个 缺口 引出 。 然 后 站 上 提供 的 黑色 《或 者 透明 ) 的 
硅胶 垫 。 这 样 在 多 次 起 降 撞击 的 时 候 ， 不 会 伤 到 电机 供电 线 。 





到 现在 ， 整 个 电机 的 安 沪 束 完成 了 。 


电池 的 安 委 


将 电池 焊接 到 飞 控 板 上 ， 注 意 电 线 留 出 合适 的 长 度 ， 一 般 是 固定 在 飞 控 板 的 下 面 ， 所 以 线 是 
焊接 到 下 面 的 。 电 池 的 红色 援 飞 控 板 的 3.7v 焊 盘 ， 黑 色 手 GND 焊 盘 。 在 电池 上 ， 我 们 已 经 沾 
上 了 双 面 胶 ， 将 胶 纸 的 保护 膜 斯 挤 ， 将 电池 固定 于 飞 控 板 正中 央 。 





= 


最 近 发 现 有 小 伙伴 尽 然 料 电 池 放 到 了 PCB 的 上 面 ， 而 且 用 绳子 固定 的 (其实 上 面 已 经 沾 了 双 


面 胶 ) 。 这 让 我 久久 不 能 平静 ， 确 实 是 我 们 文档 说 得 不 够 详细 。PCB 的 上 面 有 基本 上 所 有 的 
元 器 件 ， 容 易 造 成 短路 ， 而 且 可 能 谴 瘟 了 天 线 ， 导 致 珀 控 的 距离 缩短 。 下 面 融 是 几 个 详细 的 


Crazepony 开 源 四 轴 飞 行 二 


电池 固定 示意 图 。 最 好 是 固定 到 PCB 的 下 面 。 


将 双 面 胶 撕 开 ， 准 备 粘贴 。 


F 
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2- 
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最 后 效果 图 。 
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Crazepony 开 产 四 轴 飞 行 硬 

















下 面部 分 ， 参 考 《 入 手 试飞 教程 》。 


Crazepony 开 源 四 轴 飞 行 赴 


四 轴 飞 行 丁 


四 轴 飞 行 器 是 航模 无 人 机 中 最 常见 的 一 种 ， 为 众多 的 航模 爱好 者 所 喜欢 。 在 很 多 科幻 电影 
也 党 有 四 轴 飞 行 器 的 出 现 。 美 国电 影 《 复 仇 者 联盟 (Marvel's The Avengers) 》 中 的 空中 航 
空 母 舰 就 是 一 艘 巨大 的 四 轴 飞 行 器 。 





四 轴 飞 行 研 40 


四 轴 飞 行 器 历史 回顾 


作者 : nieyong 
四 轴 飞 行 器 是 微型 飞行 器 的 其 中 一 种 ， 也 是 一 种 和 炙 能 机 器 人 。 


1907 年 ， 法 国 Breguet 兄 瘦 制 造 了 第 一 染 四 旋 别 式 曾 升 机 ， 这 次 飞行 中 没有 用 到 任何 旋 距 式 
直升机 ， 这 次 飞行 中 没有 用 到 任何 的 控制 ， 所 以 飞行 稳定 性 是 很 甜 。 





1921 年 ，George De Bothezat 在 美国 俄 辫 俄 州 西南 部 城市 代 顿 的 美国 空军 部 建造 了 另 架 大 型 
的 四 旋翼 直升机 先后 进行 了 一 架 大 型 的 四 旋翼 直升机 ， 先 后 进行 了 100 多 次 的 飞行 试验 但 是 仍 
然 无 法 很 好 的 控制 其 飞行 ， 并 且 没 有 达到 美国 空军 标准 。 






1956 年 ，Convertawing 造 了 一 架 四 旋翼 直升机 ， 该 飞行 器 的 曙 旋 桨 在 直径 上 超过 了 19 其 
尺 ， 用 到 了 两 个 发 动机 ， 并 且 通 过 改变 每 个 螺旋 桨 提供 的 推力 了 来 控制 飞行 右 。 





美国 陆军 研制 的 VZ-7， 被 称 做 Flying Jeep， 有 效 载荷 250KG，425 马 力 涡轮 发 动机 驱动 ， 容 
易 起 飞 ， 但 不 能 满足 军 方 速 度 和 高 度 要 求 ，1960 年 被 退还 给 发 明 人 ， 美 国航 空 事业 先驱 - 柯 蒂 
斯 。 维 其 百科 -Curtiss-Wright VZ-7。 





在 此 之 后 的 数 十 年 中 ， 四 旗 履 垂下 起 降 机 没有 什么 大 的 进展 。 近 十 几 年 来 ， 随 着 微 系 统 、 传 
感 器 以 及 控制 理论 等 技术 的 发 展 四 旗 辟 垂下 起 降 机 制 理论 等 技术 的 发 展 ， 四 施 履 垂下 起 降 机 
又 引起 人 们 极 大 的 兴趣 。 研 究 集中 在 小 型 或 微型 四 旋翼 飞行 器 的 结构 、 飞 行 控制 以 及 能 源 动 
力 等 方面 。 


开 赣 四 轴 飞 行 硬 


作者 : nieyong 


APM & 3D Robotics 


3D Robotics 公 司 旗 下 的 飞 控 有 3 款 ， 分 别 是 ArduPilot (简称 APM) ，PX4 和 Pihawk。 


APM 是 比较 古老 的 版 本 ， 义 理 核 心 使 用 的 是 Arduino，16 位 mega 系 列 单片机 ， 开 发 环境 为 
arduino-IDE， 基 于 Arduino 这 点 和 MWC 飞 控 是 一 样 的 。 功 能 上 依然 很 强大 ， 地 面 站 使 用 apm- 
planner 和 mission-planner。 最 新 版 本 为 APM 2.6， 开 源 。 


PX4 是 apm 的 升级 版 ， 使 用 了 很 流行 的 stm32f407 单 片 机 ， 处 理 速 度 上 了 一 个 大 台阶 ， 摆 脱 了 
arduino 的 沥 颈 ， 走 向 了 发 烧 级 的 道路 。 不 过 PX4 实 际 上 是 由 两 部 分 组 成 的 ，PX4FMU 和 
PX41O 板 。 











后 来 又 推出 了 Pixhawk 飞 控 ， 其 实 就 是 把 PX4FMU 和 PX4IO 板 结合 在 了 一 起 ， 更 高 的 集成 度 。 





其 背后 的 商业 公司 是 3D Robotics。3D Robotics 创 始 人 是 克 里 斯 : 安 德 森 (Chris 

Anderson) ， 前 《 连 线 》 主 编 ， 著 有 《长 尾 理论 》，《 创 客 : 新 工业 革命 》 等 畅销 书 。 创 客 
运动 的 积极 倡导 者 和 领袖 级 人 物 。 有 关 克 里 斯 :安德森 和 他 的 无 人 机 ， 可 以 参看 《开源 杀 志 》 
上 的 报道 《变量 推动 者 . 克 里 斯 安 德 森 的 无 人 机 梦想 腾飞 》. 


围绕 着 3DR 公 司 的 产品 ， 形 成 了 一 个 活路 的 无 人 机 爱好 者 社区 ， 无 人 机 飞 控 功 能 很 强大 ， 能 
飞 固定 又 、 旋 层 、 直 升 机 等 。 旗 下 网 站 也 有 好 几 个 ardupilot.com、diydrones.com、 
3drobotics.com， 很 是 混杂 ， 很 多 资料 和 文档 看 的 眼花 续 乱 。 


据 业 内 人 士 透露 ，diydrones 是 现在 最 活路 的 四 轴 飞 行 器 ， 无 人 机 论坛 ， 日 活路 用 户 有 2 万 多 
《2014-6， 这 个 数据 是 否 真实 没有 验证 过 ) 。 所 以 把 这 个 放 在 第 一 位 介绍 给 大 家 。 


e。 3DR 官 网 : http://3drobotics.com/。 这 个 网 站 简单 来 说 就 是 3dr 卖 飞 控 的 官方 旗舰 店 ， 我 
还 以 为 开发 者 的 一 些 东 西 也 在 上 面 ，， 好 浪费 感情 。 

。 apm 飞 控 的 官网 : http://copter.ardupilot.com 。 见 名 知 意 ， 基 于 arduino 的 飞 控 ， 肯 定 是 
apm 的 官网 了 ， 一 些 开发 者 资料 在 http://dev.ardupilot.com。 

。 pixhawk 飞 控 的 官网 : https://pixhawk.org 。 PIX4 和 Pixhawk 的 资料 都 在 上 面 ， 此 外 上 述 
代码 都 托管 在 GitHub 上 。 

。 diydones 论 坛 : http://diydrones.com 。 这 个 是 3dr 旗 下 的 交流 论坛 ， 你 可 以 在 这 里 找到 很 
多 国外 的 飞 控 爱 好 者 。 





本 节 内 容 部 分 来 自 Wellmakers 博 客 3D Robotics 相 关 介 绍 。 


MWC & MultiWii 


MWC 是 MultiWii Copter 的 缩写 ， 是 最 为 经 典 的 开源 的 多 轴 飞 行 器 固件 。 此 固件 的 原创 作者 是 
法 国 的 Alex， 他 为 了 打造 自己 的 Y3 飞 行 器 〈 一 个 三 轴 飞 行 器 ) ， 在 开源 硬件 平台 Arduino 的 基 
础 上 开发 了 最 初 的 MWC 固 件 。 几 年 来 经 过 许多 高 手 的 参与 及 共同 努力 ， 开 发 进度 越 来 越 快 ， 
已 经 基本 成 熟 ， 支 持 三 轴 ， 四 轴 ， 六 轴 等 多 种 飞行 器 。 其 最 大 的 特点 是 ， 其 硬件 是 基于 
Arduino 平 台 。 这 为 很 多 熟悉 开源 硬件 平台 Arduino 的 玩家 入 门 提供 方便 。 


下 图 为 Alex 最 早 使 用 MWC 的 Y3 飞 行 器 。 





~ | a 
根据 使 用 Arduino 开 发 板 的 不 同 ，MWC 飞 控 有 两 种 版 本 。 


。 Atmega328P 版 本 ，32K 的 Flash，Atmel 公 司 8 位 AVR 单 片 机 内 核 
。 Atmega2560 版 本 ，256K 的 Flash，Atmel 公 司 8 位 AVR 单 片 机 内 核 


AVR 单 片 机 内 核 束 是 AVR 内 核 ， 和 51 内 核 是 不 一 样 的 ， 它 的 汇编 指 兮 与 51 单 片 机 汇编 指 
倒是 完全 不 一 样 的 。AVR 内 核 是 美国 ATMEL 公 司 研 发 的 。ATMEL 公 司 有 三 大 系列 MCU， 
一 种 是 老 陈 的 以 8051 内 核 的 单片机 ， 第 二 种 是 目前 大 量 使 用 的 以 AVR 内 核 的 AVR 单 片 
机 。 第 三 种 是 目前 高 端的 以 ARM 内 核 的 微 处 理 器 。 


所 以 我 们 可 以 使 用 Arduino Pro Mini/Arduino Mega 等 开发 板 配 合 传感器 开发 板 来 搭建 自己 的 四 
轴 飞 行 器 。 当 然 ， 需 要 有 数字 电路 和 编程 的 底子 ， 不 过 如 果 悟 性 好 ， 看 看 文档 也 能 搞 起 来 。 
主要 难点 在 于 调试 ， 很 难 把 它 调 得 很 稳 ， 需 要 很 大 的 耐心 。 


e MultiWii 官 网 : http://www.multiwii.com/ 
。 MultiWii 官 方 在 Google Code 上 的 代码 库 : http://code.google.com/p/multiwii/ 
。 MultiWii 官 方 在 Github 上 的 代码 库 : https://github.com/multiwii 


正 是 由 于 MWC 使 用 的 是 8 位 单片机 做 的 主 控 必 片 ， 在 后 来 的 发 展 中 受到 了 性 能 的 限制 。 
很 多 玩家 就 把 MWC 飞 控 代 码 移植 到 32 位 处 理 嚣 上 (例如 STM32) ， 形 成 了 BaseFlight 飞 
控 人 代码， 后 来 从 BaseFlight 项 目 又 分 出 来 (fork) 了 CleanFlight 飞 控 项 目 。 


CC3D & OpenPilot 
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OpenPilot 社 区 主要 提供 下 面 两 个 版 本 的 飞 控 硬 件 平台 : 


。 OpenPilot CopterControl Platform (又 叫 CC3D 平 台 ) 。 使 用 STM32F1 作 为 主 控 ， 没 
气压 计 ， 价 格 便宜 ， 功 能 稳定 ， 已 经 被 大 量 使 用 和 接受 。 

。 OpenPilot Revolution Platform (还 在 开发 中 ， 未 发 布 ，2015-5-2) 。 使 用 STM32F4 作 为 
主 控 。 





配合 上 面 两 个 飞 控 人 硬件 平 台 ，OpenPilot 还 提供 一 个 功能 强大 ， 支 持 中 平台 (Windows，Mac 
OS，Linux) 的 地 面 站 (包含 上 位 机 功能 ) 。 








IT、 大 4 二 品 品 A7 
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CC3D 是 现在 OpenPilot 现 在 提供 的 唯一 大 量 使 用 的 飞 控 。 由 于 其 飞 控 固 件 稳定 ， 配 置 简单 ， 

价格 便 守 ， 而 且 有 强大 的 地 面 站 上 位 机 文 持 ， 所 以 非 痢 受 欢迎 。 穿 越 机 QAV250 丈 是 使 用 的 

CC3D 作 为 默认 飞 控 ，crazepony 团 队 会 花 很 多 精力 来 研究 这 个 飞 控 ， 以 便 给 大 家 提供 更 好 的 
反 术 支持 。 


OpenpPilot 本 里 提供 的 飞 控 固 件 已 经 非常 稳定 。 但 是 很 多 穿越 机 的 玩家 会 把 CleanFlight 飞 
控 固 件 烧 入 到 CC3D 飞 控 平台 上 ， 以 获得 更 好 的 飞行 体验 。 更 多 内 容 ， 请 看 CleanFlight 飞 
控 固 件 部 分 。 


。 OpenPilot 官 网 : www.openpilot.org 
e OpenPilot Wiki : https://wiki.openpilot.org 


Cleanflight 


在 前 面谈 到 MWC 和 CC3D 飞 控 的 时 候 ， 都 有 谈 到 Cleanflight， 那 么 到 底 什 么 是 Cleanflight 呢 ? 
在 crazepony 的 wiki 中 为 什么 要 详细 单独 介绍 它 呢 ? 


正如 在 MWC 介 绍 中 提 到 的 ， 由 于 MWC 使 用 的 是 8 位 单片机 做 的 主 控 必 片 ， 在 后 来 的 发 展 中 受 
到 了 性 能 的 限制 。 很 多 玩家 束 把 MWC 飞 控 代 码 移植 到 32 位 处 理 器 上 (例如 STM32) ， 形 成 了 
BaseFlight 飞 控 人 代码， 后 来 从 BaseFlight 项 目 又 分 出 来 (fork) 了 CleanFlight 飞 控 项 目 。 
Cleanflight 其 实 只 是 一 个 基于 MWC 的 飞 控 代 码 ， 它 现在 已 经 支持 了 下 面 这 些 飞 控 硬 件 平台 : 


e AlienWii32 
e Naze32 

e CC3D 

e CJMCU 

e CheBuzzF3 
e Olimexino 


e Sparky 
上 面 的 硬件 飞 控 平台 ， 除 了 CC3D 上 比较 有 名 之 外 ，Naze32 算 是 一 个 后 起 之 秀 。 但 是 他 们 都 有 
一 个 特点 ， 基 本 上 都 是 基于 STM32 主 控 MCU， 内 核 为 32 位 ARM Contex-M。 那 么 crazepony 
的 wiki 中 为 什么 要 详细 介绍 这 个 飞 控 呢 ， 有 下 面 几 点 : 


。 crazepony 也 是 使 用 的 STM32 作 为 主 控 MCU， 而 且 硬 件 选 型 和 Naze32 完 全 一 样 ， 很 有 借 
。 CC3D 和 Naze32 飞 控 都 可 以 刷 Cleanflight 的 飞 控 ， 用 于 研究 CrazeFPV H250 穿 越 机 
。 Naze32 作 为 后 起 之 秀 ， 有 超越 CC3D 的 趋势 ， 在 国外 穿越 机 玩家 中 非常 流行 


Naze32 的 正面 图 ， 和 CC3D 最 大 的 区 别 是 它 有 加 入 气压 计 MS5611 : 





下 面 是 Cleanflight 的 官网 和 代码 库 。 


。 Cleanflight 官 网 : http://cleanflight.com/ 
。 Cleanflight 官 方 在 Github 上 的 代码 库 : https://github.com/cleanflight 


cleanflight 飞 控 几 个 大 的 特点 : 


e。 飞 控 代码 基于 MWC， 稳 定 简 洁 ; 

。 为 现在 的 32 位 处 理 器 而 开发 ， 删 除了 原来 为 了 支持 8 位 处 理 器 而 存在 的 多 余 代码 。 
。 加 入 了 很 多 好 玩 的 功能 。 例 如 支持 LED 灯 带 ， 支 持 OLED， 支 持 超声 波 传感器 
使 用 了 先进 的 代码 开发 管理 ， 代 码 结构 清晰 ， 元 余 性 强 ， 测 试 苑 分 
支持 多 个 硬件 平台 ， 例 如 CC3D，Naze32 等 


MikroKopter 


在 2006 年 10 月 24 号 ，Holger Buss 和 Ingo Busker 创 造 了 MK， 一 个 伟大 的 Mikrokopter 四 轴 社 
区 。 在 2007 年 中 ，Mikrokopter 便 像 一 个 “ 空中 的 生子 ”， 像 一 只 乌 一 样 ， 稳 步 的 停留 在 空中 。 
这 对 于 开源 四 轴 飞 行 器 是 一 个 很 大 的 里 程 碑 。 


MikroKopter 来 目 德国 。 坚 无 疑问 ，MikroKopter 这 个 名 字 来 源 于 德语 ， 对 应 的 严 文 应 该 是 
MicroCopter。 其 英文 官网 地 址 是 http://www.mikrokopter.de/en/home。 


作者 在 SVN 上 共享 了 代码 。 





KK 飞 控 


最 经 典 的 多 轴 飞 拥 ， 价 格 十 分 便于， 很 多 人 融 是 用 它 学 会 飞 四 轴 的 。 主 要 问题 是 没有 目 稳 ， 
更 不 用 说 什么 定局 、GPS 之 类 的 高 级 功能 了 。 因 为 没有 目 稳 ， 新 手 练习 起 来 不 比较 困难 ， 不 
过 对 于 从 直升机 转 过 来 的 玩家 来 说 融 是 小 case 了 。 文 持 3 轴 、 四 轴 、6 轴 、V22 的 飞行 模式 ; 


http:/www.kkmulticopter.com/ 


Paparazzl 





The Free Autopilot 


这 是 国外 一 个 开源 的 固定 列 ， 多 轴 飞 行 器 项 目 。 一 个 做 固定 经 的 朋友 购买 了 它 的 组 件 。github 
上 的 资料 ，wiki 等 都 挺 全 面 的 。 项 目 不 久 仅 只 包括 飞 控 板 的 软 硬 件 ， 包 括 从 稳 压 电源 和 GPS 到 
卡尔 曼 滤 波 代码 , 而 是 一 个 强大 和 不 断 扩 大 的 地 面 空 中 软 硬 件 群 ， 包 括 效 传 电台 ， 天 线 和 一 个 
高 度 进化 的 用 户 友 好 的 地 面 控 制 软件 界 面 。 


http://wiki.paparazziuav.org/wiki/Main Page 


https://github.com/paparazzi/ 


open drone (国内 ) 


Crazepony 开 源 四 轴 飞 行 丰 


Stpen drone 


http:/www.open-drone.org/ 





https://github.com/opendrone 


open drone 是 由 北京 的 LUG 和 创 客 组 建 的 一 个 项 目 。 但 是 没有 看 到 其 产品 。 很 可 能 还 是 一 个 
比较 松散 的 组 织 ， 没 有 以 公司 便利 的 团队 形式 存在 。 


erlerobot 


这 是 一 个 使 用 Linux 系 统 的 开源 四 轴 飞 行 器 项 目 。 他 们 的 口号 是 : Building the next generation 
of educational drones。 


http://erlerobot.com/ 

https://github.com/erlerobot 

有 上 比较 齐全 的 wiki， 并 且 使 用 gitbook 形 式 提供 四 轴 飞 行 器 开发 的 电子 书 。 
https://github.com/erlerobot/wiki/wiki 


http://erlerobot.github.io/erle_gitbook/en/ 
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四 轴 飞 行 酉 明星 产品 


作者 : nieyong 


Phantom 


A 
| EE 
PHANTOM 2 \ 


会 飞 的 照相 机 


它 前 所 未 有 地 兰 您 的 视野 重度 至 高 空 ， 随时 芋 地 


CS li 


拍 操 出 户 皇 无比 的 乌 周 加 片 及 粹 酷 视 沉 , 





Phantom 小 型 四 轴 航 担 飞 行 器 是 专门 针对 想 接 触 舰 拍 ， 但 又 吉 于 没有 经 验 、 担 心太 复 条 的 用 
户 而 设计 ， 整 体 解 决 方案 包含 飞行 器 、 目 动 控 制 、 动 力 、 遥 控 等 等 系统 ， 用 户 购买 后 只 需要 
目 配 一 部 相机 ， 进 行 简单 的 组 合 即 可 享受 航 提 的 乐趣 ， 人 免除 自行 DIY 拼 沪 、 调 试 等 等 繁复 步 


又 。 


Phantom 是 中 国 公 司 大 疆 创 新 推出 的 明星 产品 。 现 在 已 经 推出 了 最 新 的 Phantom vision+。 


AR.Drone 
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通过 WiFi 链 接 iPhone 或 者 iPad 或 者 iPod Touch， 在 一 定 荡 围 内 进行 怕 控 飞行 。 这 个 飞行 器 有 
四 个 螺旋 奖 ， 可 以 选择 四 个 环形 对 螺旋 桨 进行 保护。 飞行 器 提供 任何 飞行 角度 ， 机 体 前 方 和 
下 方 带 有 摄像 头 ， 拍 摄 围 面 实时 传送 。 


此 外 ， 飞 行 器 还 具有 重力 感 上 应、 陀螺 仪 等 部 件 ， 拥 有 条 能 飞行 技术 ， 上 自动 矫正 风力 和 环境 误 
差 ， 看 上 去 很 是 吸引 人 ,更 为 玩家 们 惊喜 的 是 ，2 台 以 上 Ar.Drone 可 模拟 蜂 战 游戏 ， 使 得 Parrot 
AR.Drone 完 全 不 在 等 同 于 一 般 的 航模 遥控 飞机 ， 而 玩家 .只 需要 到 革 果 App Store 中 下 载 相关 软 
件 即 可 。 


AR.Drone 是 法 国 公司 Parrot 的 明星 产品 。 现 在 已 经 出 到 第 三 代 。 


直升机 VS 多 旗 避 VS 固定 疼 


作者 : nieyong 


它们 有 各 目的 特点 和 支持 者 ， 同 时 又 是 


般 模 飞行 器 ， 最 音 见 的 有 直升机 ， 多 旅 又 ， 固 定 恤 。 
会 贯通 ， 举 一 反 三 。 


相互 联系 。 秆 握 了 其 中 的 一 种 融 可 以 融 


直升机 


直升机 航模 是 航模 中 最 为 资深 的 ， 也 是 对 操控 技术 要 求 最 高 的 一 类 。 非 常 适合 练习 飞 手 的 操 
控 技能 ， 能 够 飞 出 各 种 动作 ， 表 演 具 有 很 强 的 观赏 性 。 


现在 很 多 航模 比赛 也 是 以 前 升 机 类 最 为 受 关 注 和 技术 含量 最 高 。 





多 旋风 也 束 是 我 们 看 到 的 四 轴 ， 六 轴 等 飞行 器 。 是 最 近 几 年 兴起 的 一 类 航模 飞行 器 。 多 旋 踢 
操作 简单 ， 入 门 门槛 低 ， 航 模 爱 好 者 多 用 于 航 提 。 
最 近 流 行使 用 多 旋 缀 进行 第 一 视角 FPV 竞 速 比赛 ， 而 且 发 展 势 头 非 常 迅猛 。 
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固定 中 飞 行 絮 主要 需要 考虑 飞行 器 的 空气 动力 特点 。 续 航 时 间 长 ， 不 能 够 垂 前 起飞。 
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大 四 轴 VS 小 四 办 


作者 : nieyong 


按照 四 轴 飞 行 器 的 大 小 ， 我 们 粗略 的 将 四 轴 飞 行 器 分 为 大 四 轴 和 小 四 轴 。 其 有 很 多 部 分 是 相 
同 的 ， 例 如 飞 控 部 分 基本 一 样 ; 但 是 又 有 区 别 ， 例 如 动力 部 分 (包括 电机 和 电机 驱动) 就 可 
能 完全 不 相同 。 作 为 四 轴 飞 行 器 爱好 者 ， 我 们 当然 需要 知道 DIY 大 小 四 轴 的 区 别 。 


当然 ，Crazepony 是 一 个 小 四 轴 。 


大 四 轩 


大 四 轴 根 据 其 承载 能 力 的 大 小 ， 也 分 为 不 同 的 级 别 。 例 如 DJ| 的 S800 大 四 轴 ， 能 够 挂 载 专 业 的 
单反 相机 ， 主 要 用 于 电影 等 的 拍摄 ， 其 大 小 有 大 人 双手 怀抱 那么 大 。 风 火 轮 系列 则 要 小 很 
多 ， 大 概 有 脸 例 大 小 ， 适 合 挂 载 gopro 等 运动 相机 。 





对 于 航模 爱好 者 来 说 ，DIY 一 个 大 的 四 轴 飞 行 右 也 不 是 一 件 容易 的 事情 。 你 可 以 购买 品牌 厂商 
的 整套 解决 方案 ， 然 后 目 己 进行 组 委 调 试 ， 例 如 DJI 的 S800 系 列 。 不 过 对 于 很 多 爱好 者 来 说 ， 

价格 会 比较 贵 ， 一 套 S800 的 价格 在 3 万 人 民 币 左右 。 你 也 可 以 目 己 购买 组 件 ， 目 己 组 沪 。 一 般 
需要 购买 的 组 件 包括 : 飞 摊 ， 电 调 ， 无 刷 电机 ， 遥 控 器 ， 电 池 ， 支 以 等 。 当 然 ， 也 见 过 有 爱 

好 者 目 己 用 各 种 材料 DIY 支 染 ， 有 用 铝 合金 的 ， 也 有 用 木头 的 。 根 据 上 自己 的 需求 购买 组 件 DIY 
的 成 本 会 低 很 多 ， 一 般 的 可 能 融 是 羊 1000 一 羊 2000 左 右 。 


DIY 大 四 轴 需 要 有 上 比较 专业 的 知识 ， 例 如 电子 部 分 的 连接 ， 飞 行 器 结构 重心 的 调整 ， 冯 控 器 的 
对 频 和 干扰 ， 根 据 飞 行 器 结构 或 者 飞行 现场 风力 等 对 飞 控 PID 等 参数 的 调节 (简称 调 参 ) 。 总 
之 ， 如 果 有 一 个 环节 出 现 了 问题 ， 那 么 就 会 导致 飞行 器 无 法 飞 起 来 ， 或 者 出 现 炸 机 ( 指 飞行 
器 从 空中 摔 下 来 ) 或 者 失控 ( 指 飞 行 器 不 受 运 控 器 控制 ) 的 问题 。 





另外 还 需要 注意 的 一 点 是 ， 大 四 轴 由 于 其 块头 大 ， 蝶 旋 桨 转速 快 ， 撞 到 人 或 者 物 都 会 比较 危 
险 。 所 以 一 定 要 选择 无 人 ， 空 间 宽 阔 ， 视 野 好 的 地 方 进行 飞行 。 营 见 的 一 个 事故 束 是 射 桨 。 

射 桨 殉 是 飞行 器 的 螺 施 桨 因为 旋转 时 转速 太 局 ， 超 出 了 旗 收 所 承受 拉力 的 设计 值 时 ， 桨 根 断 
独 ， 由 于 旋转 时 的 巨大 惯性 ， 残 桨 像 炮弹 破片 那样 高 速 飞 出 去 ， 威 力 很 大 〈 相 对 来 说 ) ， 会 
打 伤 人 ， 所 以 形象 的 称 为 " 射 桨 "。 有 时 旗 避 固 定 螺 丝 松 脱 或 健 到 异物 导致 旋 辟 断裂 也 会 导致 射 
桨 。 如 果 射 桨 击 中 人 ， 大 其 是 眼睛 等 脆弱 的 即位 ， 会 是 非常 危险 的 。 所 以 对 于 新 手 来 说 ， 调 
四 轴 最 好 带 护 目镜 保护 眼睛 。 


小 四 轴 


小 四 轴 是 相对 于 上 面 的 大 四 轴 来 说 的 ， 这 里 我 们 指 手 擎 大 小 的 四 轴 飞 行 器 。 一 般 来 说 ， 小 四 
轴 直 接 使 用 电路 板 作为 承载 的 文 架 ， 当 然 也 有 使 用 单独 支架 的 。 


小 四 轴 由 于 其 体型 小 ， 所 以 一 般 无 法 承载 太 重 的 负载 。 但 是 用 来 研究 飞行 器 的 原理 ， 作 为 人 
门 航模 的 通道 ， 已 经 完全 绰绰有余 。 在 大 四 轴 中 提 到 的 组 件 飞 控 ， 电 调 ， 电 机 ， 遥 控 器 ， 电 
池 ， 支 染 等 都 一 样 在 小 四 轴 中 存在 ， 只 是 可 能 根据 小 四 轴 的 特点 有 些 改变 。 下 面 这 些 丈 是 小 
四 轴 的 好 人 多。 


e。 价格 便宜 ， 相 对 于 大 四 轴 动 则 上 和 干 元 的 成 本 ， 小 四 轴 一 般 几 百 块 钱 束 能 够 搞定 
。 危险 性 很 小 ， 基 本 上 随处 都 能 
e。 自己 设计 飞 控 电路 板 ， 自 己 移植 编写 开源 飞 控 程序 和 算法 。 而 大 四 轴 的 飞 控 一 般 是 丙 业 


公司 的 产品 ， 开 源 有 限 ，DIY 的 可 能 性 少 
。 由 于 小 四 轴 飞 行 的 距离 有 限 ， 所 以 可 以 省 去 遥控 器 ， 下 接 使 用 鲁能 手机 控制 


般 模 基本 概念 扫雷 


人 类 从 来 就 有 一 个 飞行 的 梦想 ， 从 风筝 到 竹 晴 贤 ， 从 热气 球 到 莱特 兄 贺 ， 从 空 客 A380 到 航天 
飞船 。 也 许 这 个 梦想 束 是 从 孩子 手中 小 小 的 航模 飞机 开始 种 下 的 种 子 ， 等 每 某 一 天 梦想 的 实 
现 。 





航模 术语 部 分 涉及 到 大 四 轴 。 如 果 大 小 四 轴 有 区 别 的 ， 会 特别 说 明 ， 谁 叫 我 们 Crazepony 是 小 
四 轴 呢 。 


Pa wae 
飞 控 坊 
e。 飞 控 : 飞 控 指 飞行 器 的 电子 控制 部 分 ， 硬 件 包括 传感器 部 分 惯性 导航 模块 和 控制 部 分 的 
MCU。 软 件 包括 控制 算法 等 。 
。 pitch，yaw，roll : 指 三 维 空间 中 飞行 器 的 旋转 状态 ， 对 应 中 文 分 别 是 俯仰 ， 航 向 ， 横 
深 。 
。 惯性 导航 模块 : 简称 IMU， 陀 螺 仪 传 感 右 和 加 速度 传 感 右 提供 的 三 轴 运 动 效 据 模块 。 
e。 运动 感 测 追踪 : 英文 Motion Tracking。 


e 地 理 坐 标 系 : 指 地 球 所 在 的 坐标 系 ， 这 个 坐标 系 是 固定 不 变 的 ， 正 北 ， 正 东 ， 正 上 方 分 
别 表示 X，Y，Z 轴 。 


。 姿态 解 算 : 英文 attitude algorithm， 也 叫做 姿态 融合 。 姿 态 解 算 是 指 把 陀螺 仪 、 加 速度 
计 、 罗 总 等 的 数据 融合 在 一 起 ， 得 出 飞行 器 的 空中 姿态 。 


。 深度 解 算 : 也 叫做 长 期 融合 。 
。 快速 结算 : 也 叫做 快速 融合 。 


。 射 桨 : 飞行 器 的 蝶 旋 桨 因为 旋转 时 转速 太 高 ， 超 出 了 旋 引 所 承受 拉力 的 设计 值 时 ， 桨 根 
断裂 ， 由 于 施 转 时 的 巨大 惯性 ， 残 桨 像 炮 弹 破 片 那样 局 速 飞 出 去 ， 威 力 很 大 (相对 来 
说 ) ， 会 打 伤 人 ， 所 以 形象 的 称 为 " 射 桨 "。 有 时 施 收 固定 螺丝 松 胸 或 全 到 异物 导致 旋 收 断 
复 也 会 导致 射 桨 。 


电机 电 调 篇 


。 有 刷 /无 刷 电机 : 有 刷 电 动机 是 内 部 含有 换 相 电 刷 的 电动 机 ， 无 刷 电机 则 不 需要 电 刷 。 


e 空心 杯 电 机 : coreless motor， 属 于 直流 、 永 磁 、 伺 服 微 特 电 机 。 空 心 杯 电机 在 结构 上 突 
破 了 传统 电机 的 转子 结构 形式 ， 采 用 的 是 无 铁心 转子 。 


e。 电 调 : 电 调 全 称 叫 做 电子 调 速 器 ， 英 文 electronic speed controller， 简 称 ESC。 用 于 控制 
电机 的 转动 ， 停 止 ， 以 及 转动 速度 。 


过 控 器 骗 


电池 元 电 二 局 


。 航模 电池 : 航模 上 使 用 的 锂电 池 ， 需 要 有 较 高 的 放电 能 力 ， 一 般 以 单位 C 表 示 ， 这 是 普通 
锂电 池 和 航模 锂电 池 最 重要 的 区 别 。 例 如 Crazepony 就 是 使 用 25C 的 350mAh 锂 电池 。 


。 电池 容量 mAh : 表示 电池 容量 ， 如 1000mah 电 池 ， 如 果 以 1000ma 放 电 ， 可 持续 放电 1 小 
时 。 如 果 以 500mh 放 电 ， 可 以 持续 放电 2 小 时 。 


。 电池 节 数 2s/3s/4s : 代表 锂电 池 的 节 数 ， 锂 电池 1 节 标 准 电压 为 3.7v， 那 和 2s 电池， 就 是 
代表 有 2 个 3.7v 电 池 在 里 面 ， 电 压 为 7.4Vv。 对 于 小 四 轴 ， 一 般 束 是 使 用 一 节 3.7Vv 电 池 就 可 
以 。 


。 平衡 充电 : 对 于 多 节 组 合 的 电池 ， 如 3s 电 池 ， 内 部 是 3 个 锂电 池 ， 因 为 制造 工艺 原因 ， 没 
办 法 保证 每 个 电池 完全 一 致 ， 充 电 放电 特性 都 有 差异 ， 电 池 串 联 的 情况 下 ， 就 容易 造成 
某 些 放电 过 歧 或 序 电 过 上 度 ， 序 电 不 饱满 等 ， 所 以 解决 办 法 是 分 别 对 内 部 单 节 电池 充电 。 
动力 锂电 都 有 2 组 线 ，1 组 是 输出 线 (2 根 ) ，1 组 是 单 节 锂 电 引 出 线 (与 s 数 有 关 ) ， 充 电 
时 按说 明 书 ， 都 插入 充电 器 内 ， 就 可 以 进行 平衡 充电 。 对 于 只 有 一 节 电 池 的 小 四 轴 ， 不 
存在 这 个 平衡 元 电 问题 。 


其 它 


部 分 内 容 参 考 了 Taculee 博 客 四 轴 飞 行 器 基础 人 门 。 


卖国 手 VS 日 本 手 


作者 : nieyong 
航模 遥控 需 根 据 操控 方式 不 一 样 ， 分 为 美国 手 和 日 本 手 。 


美国 手 也 束 是 说 左手 摇 杆 负责 油门 和 偏 航 ， 右 手 操 杆 负 责 俯仰 和 横 深 。 左 手 授 杆 上 下 为 油门 
控制 ， 左 右 是 偏 航 控 制 ; 右手 授 杆 上 下 为 信仰 控制 ， 左 右 为 横 滚 控 制 。 





对 应 的 另外 一 种 遥控 为 日 本 手 。 左 手 授 杆 负责 俯仰 和 偏 航 ， 右 手 授 杆 负责 油门 和 横 深 。 是 不 
是 很 别扭 ? 将 俯仰 和 横 滚 的 控制 分 离开 这 种 设计 太 反 人 类 了 个 人 党 得 ， 但 是 它 就 是 这 样 一 个 
标准 没 办 法 ， 日 本 人 通常 都 会 做 些 我 们 难以 理解 的 事 大 家 都 知道 的 。 


Crazepony 开 产 四 轴 飞 行 古 


(rozopon\ 
上 逢 





Crazepony 遥 控 默 认 固 件 为 美国 手 固件 。 修 改 为 日 本 手 遥 控 只 需要 重 刷 遥控 固件 就 可 

ly 
为 什么 会 有 日 本 手 和 美国 手 呢 ? 你 到 克 是 选择 哪 种 过 控 方 式 呢 ? 下 面 这 段 有 趣 的 文字 摘自 潘 
农 菲 〈 大 疆 副 总 裁 ) 的 《坚持 不 做 手机 操控 1 只 因 简 单 的 两 个 字 》 。 


玩 航 模 的 朋友 都 知 赴 美国 手 和 日 本 手 ， 美 国手 丈 是 鞋 手 油门 ， 右 手 前 进 后 退 ， 日 本 手 不 
同 (左手 : 上 下 控制 飞行 器 的 前 进 后 退 ， 左 右 控制 左右 旋转 机 关 。 右 手 : 上 下 控制 飞行 
器 上 升 下 降 ， 左 右 控 制 飞行 器 左右 平移 )。 


有 次 ， 我 和 一 个 培训 出 很 多 世界 冠军 的 香港 飞 手 聊 ， 为 什么 很 多 专业 的 飞 手 都 是 日 本 
= 


他 回答 ， 除 了 早年 设备 都 是 日 本 手 这 个 原因 外 ， 还 有 一 个 原因 : 用 并 不 惯用 的 左手 控制 
前 进 后 退 ， 左 手 的 天 生 弱 项 反而 可 以 让 飞 手 通过 训练 更 加 精细 的 操控 ， 因 此 很 多 顶级 高 
手 使 用 这 种 方式 。 


这 让 我 想到 多 年 前 我 学 日 本 剑道 时 ， 问 一 名 台湾 五 段 ， 为 什么 要 用 相对 没有 力量 的 左手 
持 剑 ， 而 更 有 力量 的 右手 仅仅 做 辅助 ? 


他 回答 ， 右 手 是 感情 ， 左 手 是 理智 ， 剑 是 危险 的 事物 ， 要 用 理智 来 操控 。 
虽然 有 有 些 立 虚 ， 但 是 这 句 话 我 倒是 记 住 了 。 


多 年 后 当 我 学 无 人 机 飞行 操控 时 ， 这 段 话 葛 然 做 出 了 最 精准 的 解释 。 


美国 手 VS 日 本 手 63 


Crazepony 开 源 四 轴 飞 行 赴 


三 维 中 pitch，yaw，roll 的 区 别 
作者 : nieyong 


玩 过 航模 ， 飞 控 的 童鞋 肯定 需要 知道 yaw, pitch and roll 的 区 别 。 这 里 给 大 家 分 享 一 下 ， 准 各 
要 做 飞 控 的 ， 或 者 想 玩 三 轴 加 速度 的 ， 或 者 玩 了 很 久 加 速度 还 没 研 究 过 哪个 是 哪个 的 ， 可 以 


Roll 










/ 


Pitch 


pitch() : 俯仰 ， 将 物体 绕 X 轴 旋转 (localRotationX) 


三 维 中 pitch，yaw，roll 的 区 别 64 


Crazepony 开 源 四 轴 飞 行 二 





yaw() : 航向 ， 将 物体 绕 Y 轴 旋转 (localRotationY) 





roll() : 横 滚 ， 将 物体 绕 Z 轴 旋转 (localRotationZ) 


三 维 中 pitch，yaw，roll 的 区 别 65 


Crazepony 开 源 四 轴 飞 行 二 





三 维 中 pitch，yaw，roll 的 区 别 


66 


四 轴 飞 行 絮 的 空气 动力 原理 


作者 : nieyong 


四 旋风 飞行 器 结构 以 及 x 模式 和 + 模式 


四 轴 飞 行 器 四 个 电机 呈 十 字形 排列 , 驱动 四 片 桨 施 转 产生 网 上 的 推力 。 四 个 电机 抽 距 几何 中 心 
的 距离 相等 , 当 对 角 两 个 轴 产 生 的 升力 相同 时 能 够 保证 力 窍 的 平衡 , 四 轴 不 会 同 任何 一 个 方 同 

倾 转 ; 而 四 个 电机 一 对 正 转 ,一 对 反 转 的 方式 使 得 绕 坚 家 轴 方 同 旋 转 的 反 扭矩 平衡 , 保证 了 四 轩 
航 同 的 稳定 。 


与 传统 的 直升机 相 比 ， 四 旋翼 飞行 器 有 下 列 优 势 : 各 个 旋 缀 对 机 身 所 施加 的 反 扭 答 与 旋 强 的 
旋转 方向 相反 ， 因 此 当 电 机 1 和 电机 3 好 时 针 旋 转 的 同时 ， 电 机 2 和 电机 4 顺 时 针 旋 转 ， 可 以 平 
衡 旋 经 对 机 映 的 反 扭 和 矩 。 


根据 用 户 目 定义 的 机 头 的 位 置 不 同 ， 四 轴 飞 行 器 可 以 分 为 X 模 式 和 + 模 陈 。X 模 式 的 机 头 方 同位 
于 两 个 电机 之 间 ， 而 + 模式 的 机 头 方 同 位 于 某 一 个 电机 上 。x 和 + 殊 是 表示 正 对 机 头 方向 时 飞行 
如 的 形状 。 如 下 图 所 示 。x 模 式 要 难 飞 一 各， 但 动作 更 灵活 。+ 模 式 要 好 飞 一 点 ， 动 作 灵 活 看 
一 氮 ， 所 以 适合 初学 者 。 特 别 注 意 ，X 模 了 式 和 + 模 陈 的 飞 控 安 委 是 不 同 的 。 如 果 飞 控 板 安 委 错 
误 ， 会 剧烈 的 晃动 ， 根 本 无 法 飞 。 


crazepony 使 用 的 是 Xx 模 式 。 
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宪 气 动力 原理 


四 旋 吕 飞行 器 在 空间 共有 6 个 自由 度 (分 别 治 3 个 坐标 轴 作 平移 和 旋转 动作 ) ， 这 6 个 目 由 度 的 
控制 都 可 以 通过 调节 不 同 电 机 的 转速 来 实现 。 基 本 运动 状态 分 别 是 : 


。 垂直 运动 ; 
。 信仰 运动 ; 
e 滚 转 运动 ; 
。 偏 航 运动 ; 
e 名 后 运动 ; 
e。 侧 癌 运动 。 


在 图 中 ， 电 机 1 和 电机 3 作 邓 时 针 施 转 ， 电 机 2 和 电机 4 作 顺 时 针 施 转 ， 规 定 治 x 轴 正方 向 运动 称 
为 癌 前 运动 ， 箭 头 在 旗 辟 的 运动 平面 上 方 表示 此 电机 转速 提高 ， 在 下 方 表示 此 电机 转速 下 


降 。 


垂直 运动 : 垂直 运动 相对 来 说 比较 容易 。 在 图 中 ， 因 有 两 对 电机 转向 相反 ， 可 以 平衡 其 对 机 
吴 的 反 扭 矩 ， 当 同时 增加 四 个 电机 的 输出 功率 ， 施 屠 转 速 增加 使 得 总 的 拉力 增 大 ， 当 总 拉力 
足以 克服 整 机 的 重量 时 ， 四 旋翼 飞行 器 便 离 地 垂直 上 升 ; 反之 ， 同 时 减 小 四 个 电机 的 输出 功 
率 ， 四 旋翼 飞行 器 则 垂直 下 降 ， 直 至 平衡 落地 ， 实 现 了 治 z 轴 的 垂直 运动 。 当 外 界 扰动 量 为 需 
时 ， 在 旋翼 产 生 的 升力 和 寺 于 飞行 器 的 自重 时 ， 飞 行 器 便 保 持 甚 停 状 态 。 保 证 四 个 旋 缀 转速 同 
步 增 加 或 减 小 是 垂直 运动 的 关键 。 


俯仰 运动 : 在 图 (b) 中 ， 电 机 1 的 转速 上 升 ， 电 机 3 的 转速 下 降 ， 电 机 2、 电 机 4 的 转速 保持 不 
变 。 为 了 不 因为 旋 履 转速 的 改变 引起 四 旗 避 飞 行 器 整体 扭 中 及 总 拉力 改变 ， 旗 台 1 与 旋 屠 3 转 
速 该 变量 的 大 小 应 相等 。 由 于 旋 距 1 的 升力 上 升 ， 旋 缀 3 的 升力 下 降 ， 产 生 的 不 平衡 力 粉 使 机 
号 绕 y 轴 旋转 方向 如 图 所 示 ) ， 同 理 ， 当 电机 1 的 转速 下 降 ， 电 机 3 的 转速 上 升 ， 机 号 便 绕 y 
轴 同 另 一 个 方向 旋转 ， 实 现 飞行 器 的 信仰 运动 。 





滚 转 运动 : 与 图 b 的 原理 相同 ， 在 图 c 中 ， 改 变 电 机 2 和 电机 4 的 转速 ， 保 持 电 机 1 和 电机 3 的 转 
速 不 变 ， 则 可 使 机 身 绕 x 轴 旋转 〈 正 向 和 反 向 ) ， 实 现 飞 行 器 的 滚 转运 动 。 


偏 航运 动 : 四 旗 履 飞行 器 偏 航 运动 可 以 信 助 旋 恤 产生 的 反 扭 息 来 实现 。 旗 履 转 动 过 程 中 由 于 
空气 阻力 作用 会 形成 与 转动 方向 相反 的 反 扭 号， 为 了 克服 反 扭 算 影 响 ， 可 使 四 个 旗 履 中 的 两 
个 正 转 ， 两 个 反 转 ， 且 对 角 线 上 的 各 个 施 辟 转动 方向 相同 。 反 扭 算 的 大 小 与 旗 辟 转速 有 天 ， 
当 四 个 电机 转速 相同 时 ， 四 个 施 履 产生 的 反 扭 矩 相互 平衡 ， 四 旗 辟 飞行 器 不 发 生 转动 ; 当 四 
个 电机 转速 不 完全 相同 时 ， 不 平衡 的 反 扭矩 会 引起 四 旋 距 飞行 器 转 动 。 在 图 d 中 ， 当 电机 1 和 


电机 3 的 转速 上 升 ， 电 机 2 和 电机 4 的 转速 下 降 时 ， 旗 台 1 和 施 收 3 对 机 身 的 反 扭 中 大 于 施 履 2 和 
旗 收 4 对 机 身 的 反 扭 托 ， 机 身 便 在 下 余 反 扭矩 的 作用 下 绕 z 轴 转动 ， 实 现 飞 行囊 的 偏 航 运动 ， 
转 同 与 电机 1、 电 机 3 的 转 同 相 反 。 





前 后 运动 : 要 想 实 现 飞行 器 在 水 平面 内 前 后 、 左 右 的 运动 ， 必 须 在 水 平面 内 对 飞行 器 施加 一 
定 的 力 。 在 图 e 中 ， 增 加 电机 3 转速 ， 使 拉力 增 大 ， 相 应 减 小 电机 1 转速 ， 使 拉力 减 小 ， 同 时 保 
持 其 它 两 个 电机 转速 不 变 ， 反 扭矩 仍然 要 保持 平衡 。 按 图 b 的 理论 ， 飞 行 器 首先 发 生 一 定 程度 
的 倾斜 ， 从 而 使 旋翼 拉力 产生 水 平分 量 ， 因 此 可 以 实现 飞行 器 的 前 飞 运 动 。 疝 后 飞行 与 向 前 
飞行 正好 相反 。 当 然 在 图 b 图 c 中 ， 飞 行 器 在 产生 俯仰 、 翻 滚 运 动 的 同时 也 会 产生 治 x、y 轴 的 
水 平 运 动 。 

倾向 运动 : 在 图 f 中 ， 由 于 结构 对 称 ， 所 以 倾向 飞行 的 工作 原理 与 前 后 运动 完全 一 样 。 





J 


总 得 来 说 就 是 控制 四 个 电机 的 速度 了 。 然 后 相应 的 提高 速度 和 减 慢 速 度 就 可 以 让 四 轴 动 起 来 
了 。 

/一 上 OO )，、 汗 、 
飞行 古 构 造 公 开课 


厅 省 理工 学 院 公 开课 : 飞行 堪 构 知 工 程 ， 来 目 网 易 公 开课 。 讲 病 Prof. Jeffrey Hoffman,Prof. 
Aaron Cohen， 教 授 ， 鲁 供职 于 美国 国家 航空 航天 局 (NASA) 。 


无 头 模式 VS 有 头 mohican 


作者 : nieyong 


飞行 器 在 飞行 的 过 程 中 ， 其 运动 的 前 后 左右 以 地 理 坐 标 系 为 参考 坐标 条 ， 则 为 无 头 模 式 (又 
叫 head-free 或 head-hold) 飞行 。 无 头 模式 多 见于 多 旋翼 ， 例 如 四 轴 ， 六 轴 飞 行 器 中 。 


相对 应 的 融 是 有 头 模 了 式 ， 飞 行 器 运动 的 前 后 左右 以 目 身 的 坐标 系 为 参考 坐标 系 。 有 头 模式 是 
很 多 玩具 航模 ， 大 多 旋 收 飞行 器 〈 例 如 Phantom) 剃 用 的 飞行 模式 。 


无 头 模式 & 有 头 模 式 


这 里 有 必要 对 上 面 的 定义 做 展开 讲解 。 任 何 飞 行 器 都 一 吓 有 个 目 届 的 坐标 系 ， 也 束 是 飞行 器 
的 头 ， 尾 ， 这 也 束 是 前 面 说 的 飞行 器 的 目 映 坐标 系 。 如 果 推 动 膛 控 器 的 同 前 运动 ， 飞 行 器 总 
是 向 它 头 的 方向 飞行 ， 那 么 这 个 飞行 器 束 是 运行 在 有 头 模 式 。 如 果 推 动 双 控 器 的 向 前 飞行 ， 
飞行 丁 还 人 即使 这 个 时 候 飞 行 器 在 飞行 的 过 程 中 改变 了 机 头 
方向 〈 操 纵 了 遥控 的 航 同 角 ) ， 那 么 这 个 飞行 器 的 运行 在 无 头 模式 。 


所 以 可 以 看 到 ， 无 头 模 陈 飞行 器 是 以 它 起 飞 时 头 指示 的 方 同 为 前 ， 其 运行 的 前 后 左右 是 参考 
地 理 坐 标 系 (也 就 是 地 球 坐 标 系 ) 。 所 以 飞 无 头 模 式 ， 操 控 手 尽量 不 要 旋转 ， 否 则 就 会 混淆 
运行 的 前 后 左右 。 


无 头 模 式 的 乐趣 


飞行 过 程 中 ， 无 需 考 虑 机 头 的 方 同 ， 对 于 速度 飞行 会 更 玄 。 


如 何 实现 无 头 模 式 


前 面 有 说 到 ， 飞 行 器 无 头 模式 是 以 地 理 坐 标 系 ， 也 融 是 地 球 坐 标 系 为 参考 ， 所 以 最 部 见 的 实 
现 ， 融 是 使 用 电子 罗盘 ， 测 量 飞行 器 相对 于 地 球 倍 场 的 角度 ， 算 出 机 头 在 磁场 中 的 方 癌 。 


另外 ， 就 是 使 用 航向 角 的 积分 ， 计 算 飞 行 器 相对 于 起 飞 时 机 头 旋转 的 角度 。 这 就 是 crazepony 
无 头 模 了 式 的 实现 。 有 天 无 头 模式 算法 的 实现 ， 参 考 todo。 


全 By/ ] 


Crazepony 上 默认 固件 为 无 关 模 式 。 


Crazepony 开 源 四 轴 飞 行 二 


四 轴 飞 行 絮 基本 组 成 部 分 


本 章 将 会 为 讲解 四 轴 飞 行 器 的 基本 组 成 部 分 ， 很 多 都 争 对 Crazepony 迷 你 四 轴 飞 行 器 做 了 特殊 
的 说 明 。 但 是 很 多 基本 组 成 部 分 ， 大 小 四 轴 都 是 相同 的 。 按 照 模块 划分 ， 主 要 有 下 面 几 个 部 
sa 


。 动力 部 分 : 电机 ， 电 机 了 驱动 ， 桨 叶 
。 控制 部 分 : MCU， 传 感 器 (IMU) ， 和 遥控 通信 (2.4G 和 蓝牙 ) 
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航模 电机 


作者 : nieyong 


电动 机 有 有 刷 和 无 刷 之 分 。 结 构 上 ， 无 刷 电 机 和 有 有 刷 电 机 有 相似 之 处 ， 也 有 转子 和 定子 ， 只 
不 过 和 有 刷 电 机 的 结构 相反 ; 有 刷 电 机 的 转子 是 线圈 绕组 ， 和 动力 输出 轴 相 连 ， 定 子 是 永 磁 
磁 钢 ; 无 刷 电机 的 转子 是 永 磁 磁 钢 ， 连 同 外 亮 一 起 和 输出 轴 相 连 ， 定 子 是 绕组 线 图 ， 去 掉 了 
有 刷 电 机 用 来 交替 变换 电 人 磁场 的 换 向 电 刷 ， 故 称 之 为 无 刷 电 机 (Brushless motor) 。 


有 有 刷 电机 


有 刷 电 动机 是 内 部 含有 换 相 电 刷 的 电动 机 。 什 么 是 电 刷 呢 ， 直 接 上 图 。 电 刷 通 过 绝缘 座 固 定 
在 电动 机 后 盖 上 ， 将 电源 的 正 负极 引入 到 转子 的 换 相 器 上 ， 而 换 相 器 连通 了 转子 上 的 线 图 ， 
线 图 极 性 不 断 的 交 蔡 变换 与 外 这 上 固定 的 磁铁 形成 作用 力 而 转动 起 来 。 下 图 是 将 现在 
Crazepony 使 用 的 电机 拆 解 之 后 看 到 的 电 刷 和 换 相 器 。 





换 相 器 
” 电 刷 


有 刷 电机 由 于 电 刷 和 换 相 器 之 间 的 物理 接触 ， 所 以 有 摩擦 大 ， 发 热 大 ， 效 率 低 等 缺 各 。 但 是 
有 刷 电 机 同 祥 具有 制造 简单 ， 成 本 低廉 的 优点 ， 所 以 现在 市 面 上 有 刷 电 机 仍然 占有 很 大 份 


撤 \。 


无 刷 电机 


有 刷 电 机 通过 电 刷 和 换 相 器 这 种 结构 设计 获得 固定 方向 的 磁场 作用 力 而 转动 起 来 。 无 刷 电机 
没有 电 刷 和 换 相 器 ， 它 是 如 何 获得 固定 方向 的 磁场 作用 力 的 呢 ? 简单 而 言 ， 依 靠 改 变 输入 到 
无 刷 电机 定子 线圈 上 的 电流 波 交 变频 率 和 波形 ， 在 绕组 线圈 周围 形成 一 个 绕 电 机 几何 轴 心 旋 
转 的 人 磁场， 这 个 磁场 驱动 转子 上 的 永 磁 人 磅 钢 转动 ， 电 机 珊 转 起 来 了 。 


电机 的 性 能 和 磁 钢 数量 、 磁 钢 磁 通 强 度 、 电 机 输入 电压 大 小 等 因素 有 关 ， 更 与 无 刷 电 机 的 控 
制 性 能 有 很 大 关系 ， 这 束 是 无 刷 电机 配合 的 电 调 需 要 解决 的 问题 。 


无 刷 电机 拥有 动力 足 ， 寿 命 长 ， 效 率 忆 等 优势 。 所 以 大 四 轴 都 是 用 无 刷 电机 的 ， 模 型 无 刷 电 
机 的 外 观 如 下 ， 区 别 于 有 刷 电 机 ， 最 明显 的 融 是 无 刷 电机 有 三 根 线 ， 并 且 配 合 电 调 使 用 。 





无 刷 电机 最 重要 的 一 个 参数 是 KV 值 ， 这 个 数值 是 无 刷 电机 独 有 的 一 个 性 能 参数 ， 是 判断 无 刷 
电机 性 能 特点 的 一 个 重要 数据 。 


无 刷 电机 KV 值 定义 为 转 建 /伏特 ， 蕊 思 为 输入 电压 增加 1 伏特 ， 无 刷 电 机 空转 转速 增加 的 
转速 值 ( 转 /分 钟 ) 。 总 这 个 定义 来 看 ， 我 们 能 知 但 ， 无 刷 电机 电 太 的 输入 与 电机 空转 转 
速 是 章 循 严格 的 线性 比例 关系 的 。 


例如 : 某 无 刷 电 机 KV 值 为 1000KV， 意 思 是 此 电机 在 1V 电 压 下 ， 每 分 钟 转速 为 1000 转 。 则 在 
10V 电 压 下 ， 此 电机 转速 为 : 10V*1000KV=10000 转 /分 ， 当 然 这 些 都 是 在 电机 空 载 的 时 候 。 
绕 线 还 数 多 的 ，KV 值 低 ， 最 高 输出 电流 小 ， 但 投 力 大 。 
绕 线 呈 数 少 的 ，KV 值 高 ， 最 高 输出 电流 大 ， 但 扭力 小 。 


这 里 可 以 扩展 一 下 ， 为 什么 四 轴 飞 行 器 都 是 使 用 的 外 转子 无 刷 下 流 电 机 呢 ?外 转子 电机 将 原 
来 处 于 中 心 位 置 的 磁 钢 做 成 一 片 片 , 贴 到 了 外 亮 上 ,电机 运行 时 ,是 整个 外 亮 在 转 ,而 中 间 的 线 图 
定子 不 动 。 外 转子 无 刷 下流 电 机 较 内 转子 来 说 ,转子 的 转动 惯量 要 大 很 多 (因为 转子 的 主要 质量 
都 集中 在 外 吉 上 ), 所 以 转速 较 内 转子 电机 要 慢 , 通 弟 KV 值 在 几 百 到 几 千 之 间 , 用 在 航模 上 可 以 起 
接 驱 动 螺 施 桨 ,而 省 去 了 机 械 减 速 机 构 。 〈 摘 目 《 无 感 无 刷 下 流 电 机 之 电 调 设计 全 攻略 》 ) 


电机 之 空心 杯 


空心 杯 电 机 (coreless motor) 属于 直流 、 永 磁 、 伺 服 微 特 电机 。 空 心 杯 电 机 在 结构 上 突破 了 
传统 电机 的 转子 结构 形式 ， 采 用 的 是 无 铁心 转子 。 空 心 杯 电 机 具有 十 分 突出 的 节能 、 控 制 和 
拖 动 特性 。 


衬 心 杯 电 机 分 为 有 刷 和 无 刷 两 种 ， 有 刷 空 心 杯 电机 转子 无 铁心 ， 无 刷 空 心 杯 电 机 定子 无 铁 


N 
/LNo 


Crazepony 使 用 的 是 有 刷 空 心 杯 电机 ， 转 速 为 30000 转 /分 钟 ， 下 径 为 ?mm， 长度 为 
20mm (简称 720 电 机 ) ， 电 机 轴 直 径 为 Imm。 当 然 ， 随 着 现在 生产 工艺 的 进步 ， 现 在 市 面 上 
已 经 有 体积 非常 小 的 航模 无 刷 电 机 ，Crazepony 也 会 党 试 使 用 无 刷 电机 。 


Crazepony 空 心 杯 高 速 电 机 拆 解 图 ， 可 以 明显 看 到 线 图 中 间 没 有 铁心 的 。 





扩 版 阅读 


天 于 无 刷 直 流 电 机 原理 的 讲解 。 
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般 模 电机 驱动 控制 


作者 : nieyong 


电机 驱动 控制 就 是 控制 电机 的 转动 或 者 停止 ， 以 及 转动 的 速度 。 电 机 驱动 控制 部 分 也 叫做 电 
子 调 速 器 ， 简 称 电 调 ， 英 文 electronic speed controller (ESC) 。 电 调 对 应 使 用 的 电机 不 同 ， 
分 无 刷 电 调 和 有 刷 电 调 。 


有 有 刷 电 机 的 永 磁 体 是 固定 不 动 的 ， 线 圈 绕 在 转子 上 上， 通过 电 刷 跟 换 相 器 接触 来 改变 磁场 方 同 
来 保持 转子 持续 转动 。 无 刷 电 机 ， 顾 名 思 义 ， 这 种 电机 是 没有 电 刷 和 换 相 器 的 ， 他 的 转子 是 
永 磁 体 ， 而 线圈 是 固定 不 动 的 ， 直 接 接 到 外 部 电源 ， 问 题 就 来 了 ， 线 图 磁场 方向 怎么 改变 
呢 ?事实 上 ， 无 刷 电机 外 部 还 需要 一 个 电子 调 速 嚣 ， 这 个 调 速 器 束 是 一 个 电机 了 驱动 ， 通 过 改 
变 固定 线圈 内 部 电流 的 方向 ， 保 证 它 跟 永 磁体 之 间 的 作用 力 是 相互 排斥 ， 持 续 转 动 得 以 延 
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PWM 占 空 比 控制 电机 转速 

















无 刷 电 调 这 里 是 三 相交 流 电 …… 


有 刷 电 机 工作 可 以 不 需要 电 调 ， 军 接 把 电 供给 电机 束 能 够 工作 ， 但 是 这 样 无 法 控制 电机 的 转 
束 。 无 刷 电 机 工作 必须 要 有 电 调 ， 否 则 是 不 能 转动 的 。 必 须 通 过 无 刷 电 调 将 让 流 电 转化 为 三 
相交 流 电 ， 输 给 无 刷 电机 才能 转动 。 


一 般 使 用 PWM 的 占 空 比 来 控制 电机 的 转速 。 


Crazepony 电 机 了 驱动 


无 刷 电 机 的 操作 相对 来 说 是 比较 麻烦 的 ， 而 有 刷 电 机 融 是 我 们 小 时 候 玩 的 四 驱车 上 的 那 种 电 
机 ， 接 上 电 融 能 猛 转 ， 反 着 接 它 束 反 着 猛 转 ， 束 是 这 么 简单 。 


Crazepony 使 用 的 是 有 刷 空 心 杯 电 机 ， 所 以 电机 的 控制 属于 有 刷 直 流 电机 控制 ， 相 对 于 无 刷 电 
调 来 说 要 简单 很 多 。Crazepony 采 用 的 是 有 刷 空心 杯 高 速 电 机 ， 转 速 在 3W 转 /分 钟 左 右 。 要 了 驱 
动 有 刷 电 机 ， 很 简单 ， 只 需要 将 信号 的 驱动 能 力 增 大 ， 就 能 驱动 有 刷 电 机 了 。 


那么 选择 什么 元 件 来 提供 这 样 的 特性 呢 ?Crazepony 的 电机 驱动 IC 选 型 经 历 了 三 级 管 ， 中 功率 
宰 的 失败 ， 最 后 选用 的 是 场 效 应 时 〈 即 MOSFET) SI2302。 


由 于 笔者 完全 是 由 于 一 种 强烈 的 爱好 选择 了 飞行 器 ， 最 开始 连 有 刷 电 机 和 无 刷 电机 的 物理 结 
构 区 别 都 不 知道 ， 电 调 又 是 哈 ? 傻 傻 分 不 清楚 ..….…… 


从 一 个 几乎 规 基 础 的 状态 去 选择 电机 驱动 芯片 ， 弯 路 是 必须 要 走 的 ， 学 费 是 必须 要 交 
的 。 便 以 为 书 上 学 到 的 东西 马上 就 能 用 ， 马 上 能 转化 为 产品 ， 后 来 发 现 真 的 是 自己 想 多 
了 。 


最 开始 用 的 三 极 管 作为 电机 驱动， 采用 很 经 典 的 共 射 电路 "三极管 工作 在 开关 状态 应 该 束 行 了 
吧 ?" 于 了 用 三 极 管 驱动 的 PCB 板 ， 发 现 电 机 越 转 越 慢 ， 根 本 没劲 。 "也许 是 因为 三 极 管 红 不 了 
大 电流 ， 好 吧 那 我 换个 中 功率 管 吧 ， 集 电极 最 大 6A 电 流行 了 吧 ? "可 以 想象 结果 是 不 行 的 。 





首先 了 解 下 为 什么 三 极 管 作为 简单 的 电机 了 驱动 是 不 可 取 的 方案 : 


。 三 极 管 作为 一 个 古老 的 半导体 先驱 ， 它 是 以 一 个 放大 器 件 的 姿态 而 出 现 的 ， 它 在 线性 区 
域 特性 集中 ， 饱 和 和 与 截止 都 是 两 种 极端 的 工作 状态 ， 而 作为 电机 驱动 的 话 ， 我 们 只 能 选 
择 它 的 这 两 种 极端 工作 模式 。 

。 用 三 极 管 作 为 大 电流 负载 的 驱动 管 时 ， 不 得 不 考虑 的 是 他 自身 的 管 压 降 对 负载 的 影响 ， 
这 是 很 严重 的 。 自 身 耗 散 越 来 越 大 ， 电 机 和 管子 是 串联 关系 ， 电 池 电 压 只 有 3.7V， 电 机 
束 只 能 越 转 越 慢 了 


在 晶体 管家 族 里 面 还 有 一 种 跟 三 极 管 特 性 互补 的 ， 所 有 特性 都 集中 在 开 天 状 态 的 晶体 管 ， 场 
效应 党 ， 即 MOSFET。 通 弟 的 场 效 应 管 完全 导 通 时 ， 源 漏 极 电阻 都 是 mQ 级 别 的 ， 即 它 目 号 的 
耗 散 非常 小 。 用 它 做 为 驱动 省 再 合适 不 过 了 。 最 终 选 择 了 一 个 SOT23 封 沪 的 , 导 通 电压 Vgs<4v 
的 场 省 (SI2302) ,结果 表现 出 了 很 好 的 驱动 性 能 。 


Notor3 





每 个 场 效 应 时 接 一 个 大 电阻 下 拉 ， 目 的 是 为 了 防止 在 单片机 没 接手 电机 的 控制 权时 ， 电 机 由 
于 PWM 信号 不 稳定 开始 猛 转 。 接 一 个 下 拉 电 阻 ， 保 证 了 场 雪 输入 信号 要 么 是 局 ， 要 么 是 低 ， 
没有 不 确定 的 第 三 种 状态 。 那 么 电机 也 只 有 两 种 状态 。 要 么 转 ， 要 么 不 转 。 主 控 输 出 的 是 
PWM 波 形 ， 用 于 控制 场 效应 管 的 关闭 和 导 通 ， 从 而 控制 电机 的 转动 速度 。 这 束 是 crazepony 
电机 了 驱动 的 原理 。 束 是 这 么 简单 。 


无 刷 电 调 〈 读 做 tiao) 


在 《电机 和 与 桨 叶 》 一 文中 ， 我 们 提 到 大 四 轴 基 本 上 都 是 使 用 的 无 刷 电 机 ， 无 刷 电 机 控制 必须 
配合 无 刷 电 调 使 用 。 


无 刷 电 调 的 输入 是 站 流 ， 通 汕 直接 接 航 模 电 池 。 输 出 是 3 根 线 ， 了 驱动 无 刷 电机 。 另 外 无 刷 电 调 
还 有 三 根 信号 线 ， 一 般 输 入 PWM 信号 ， 用 于 控制 电机 的 转速 。 对 于 航模 ， 盛 其 是 四 轴 飞 行 
器 ， 由 于 其 特殊 性 ， 需 要 专门 的 般 模 电 调 。 





那么 为 什么 在 四 轴 飞 行 器 上 需要 专门 的 电 调 呢 ， 其 有 什么 特别 的 地 方 ? 四 轴 飞 行 器 有 四 个 
桨 ， 两 两 相对 呈 十 字 区 叉 结 构 。 在 桨 的 转向 上 分 正 转 和 反 转 ， 这 样 可 抵消 单个 奖 叶 施 转 引起 
的 目 施 问题 。 每 个 浆 的 直径 很 小 ， 四 个 桨 转动 时 的 离心 力 是 分 散 的 。 不 像 下 机 的 桨 ， 只 有 一 
个 能 产生 集中 的 离心 力 形成 陀螺 性 质 的 惯性 离心 力 ， 保 持 机 身 不 容易 很 快 的 侧 翻 挥 。 所 以 通 
剃 航 模 站 升 机 用 到 的 电机 控制 信号 更新 频率 很 低 ， 而 航模 四 轴 飞 行 器 用 到 的 控制 信号 更 新 频 
率 很 高 。 


四 轴 为 了 能 够 快速 反应 ， 以 应 对 姿态 变化 引起 的 球 移 ， 需 要 高 反应 速度 的 电 调 ， 常 规 PPM 电 
调 的 更 新 速度 只 有 50Hz 左 右 ， 满 足 不 了 这 种 控制 所 需要 的 速度 ， 且 PPM 电 调 MCU 内 畦 PID 稳 
速 控 制 ， 能 对 常规 航模 提供 顺 滑 的 转速 变化 特性 ， 用 在 四 轴 上 就 不 合适 了 ， 四 轴 需 要 的 是 快 
速 反 应 的 电机 转速 变化 。 用 高 速 专用 电 调 ，1IC 总 线 接口 传送 控制 信号 ， 可 达到 每 秒 几 百 上 二 
次 的 电机 转速 变化 ， 在 四 轴 飞 行 时 ， 姿 态 时 刻 能 够 保持 稳定 。 即 使 受到 外 力 突然 冲击 ， 依 旧 
安然 无 匡 。 


对 于 四 轴 飞 行 器 ， 我 们 一 般 使 用 无 感 无 刷 下 流 电 机 ， 电 调 利用 第 三 相 的 感 生 电 动 势 来 测量 转 
子 位 置 。 而 对 应 的 车 模 和 舱 模 ， 因 为 其 电机 需要 频 每 启动 、 俘 止 、 反 转 ,而 且 对 整套 动力 系统 
的 重量 也 不 是 十 分 讲究 , 故 用 有 感 无 刷 电机 ， 电 调 使 用 电机 上 的 霍 尔 效应 器 件 来 检测 转子 的 位 
蕊 。 


下 图 为 车 模 / 船 模 上 使 用 的 有 感 无 刷 直 流 电机 及 对 应 的 电 调 ，Hobbywing (好 盈 ) 公司 的 
Quicrun 系 多 3650 型 与 。 








扩 屡 阅读 


。 《无 感 无 刷 赴 流 电 机 之 电 调 设 计 全 攻略 》 一 一 笔者 最 早 看 到 这 份 文档 ， 来 自 阿 莫 论 坛 。 
作者 是 timegate 办 苗 。 对 四 轴 飞 行 器 无 刷 电 机 / 电 调 入 门 和 深入 都 非常 合适 ， 强 烈 推荐 。 
在 Crazepony 的 百度 盘 中 提供 一 份 下 载 。 


。 TI 公司 天 于 电机 驱动 和 控制 解决 方案 。 


航模 桨 叶 


作者 : nieyong 


桨 叶 


螺旋 桨 的 型 号 由 如 8045，1038 等 4 位 数字 表示 ， 分 别 代表 浆 叶 两 个 重要 的 参数 ， 桨 直径 和 桨 
螺 距 。 浆 直径 是 指 浆 转动 所 形成 的 圆 的 直径 ， 对 于 双 叶 桨 〈 两 片 桨 叶 ， 这 是 最 常用 的 桨 ) 恰 
好 是 两 片 桨 叶 长 度 之 和 ， 由 前 两 位 数字 表示 ， 如 上 面 的 80 和 10， 单 位 为 英寸 。 桨 螺 距 则 代表 
桨 旋转 一 周 前 进 的 距离 ， 由 后 两 位 数字 表示 ， 如 上 面 的 45 和 38。 桨 直径 和 螺 距 越 大 ， 桨 能 提 
供 的 拉 ( 推 ) 力 越 大 。 


以 Phantom 的 奖 叶 为 例 。Phantom 1 使 用 的 是 8045 的 桨 叶 ， 表 示 浆 直径 为 8 英寸 
(8x2.54=20.32 厘 米 ) ， 奖 螺 距 为 4.5 磋 寸 ; 而 Phantom 2 使 用 的 是 9443 的 奖 叶 ， 表 示 奖 直径 
为 9.4 关 寸 ， 桨 曲 距 为 4.3 喘 寸 。 从 浆 叶 的 规格 可 以 看 出 ，Phantom 的 第 二 代 能 够 提供 更 大 的 动 
力 。 


对 于 玩 大 四 轴 的 人 来 说 ， 桨 叶 的 材质 也 是 非常 有 考究 的 。 根 据 桨 叶 使 用 材质 的 不 同 ， 现 在 市 
面 上 有 的 包括 碳 纤 桨 ， 木 桨 ， 注 塑 桨 。 


注塑 浆 : 注塑 桨 是 指使 用 塑料 等 复合 材料 制 成 的 桨 叶 。 在 航模 爱好 者 中 以 美国 APC 公 司 生产 
的 桨 叶 最 为 有 有 名， 质量 最 好 。 淘 宝 上 也 有 三 种 大 类 ， 分 别 是 原 久 APC，ATG 生 产 的 假 APC， 
以 及 不 知名 小 厂 生 产 的 最 廉价 的 有 APC 浆 外 观 的 塑料 桨 。 


APC 浆 有 一 个 衍生 系列 多 轴 专 用 的 MR 系列 。 优 点 是 增强 了 桨 的 硬度 ， 减 少 了 重量 ， 骨 次 提高 
效率 ， 解 决 了 之 前 的 高 速 转动 浆 尖 变形 问题 。 缺 后 是 价格 较 贵 ， 原 小 价格 在 89-128 之 间 ， 并 
且 无 合 运 的 垫 图 ， 需 要 上 自己 找 物料 缩小 孔径 。 


碳 纤 交 


碳纤维 是 一 种 与 人 造 丝 ， 合 成 纤维 一 样 的 纤维 状 碳 材 料 。 由 于 碳纤维 的 材料 原因 ， 它 有 优异 
的 硬度 和 合适 的 浆 型 ， 非 常 适合 技巧 性 飞行 和 3D 飞 行 。 碳 纤 浆 效率 优 于 木 桨 ， 价 格 比 木 浆 更 
贵 ， 稍 微 低 于 原 攻 APC。 


rr | 
PT = 


碳 纤 的 前 身 -- 碳 纤 布 盖 碳纤维 表层 结构 站 





几 种 不 同 的 碳 纤 桨 叶 。 


EE 此 结构 一 般 是 电机 上 在 辅助 孔 自 锁 结 构 是 比较 新 型 的 结构 折合 结构 是 通过 铝 件 来 实现 桨 
固定 ,选择 里 要 注意 孔径 大 小 | 通过 桨 附带 的 配件 进行 连接 ， 一 般 是 电机 上 有 牙 , 沫 十 面 配 叶 之 则 的 活动 ， 优 点 是 方便 携 
对 应 的 电机 类 型 。 | 用 痢 丝 固定 。 ”有 牙 孔 ,直接 转 上 去 即 因 十。 带 ， 缺 点 是 安装 费事 。 





木 浆 


浆 的 材料 多 为 样 木 ， 硬 度 高 ， 重 量 轻 ， 经 过 风干 打 虹 上 漆 以 后 不 人 受潮 。 在 航空 史上 ， 木 
桨 在 早期 扮演 了 非常 重要 的 角色 。 一 战 时 期 的 很 多 飞机 都 是 使 用 的 木 桨 ， 后 来 才 逐 渐 被 铁 桨 
取代 。 专 门 提供 飞行 器 的 木 浆 的 公司 sensenich。 





在 航模 爱好 者 中 ， 木 桨 主要 用 在 固定 如 飞行 器 上 ， 最 为 高 端的 是 欧洲 XOAR 公 司 的 木 奖 。 





下 面 是 一 个 提供 了 很 多 关于 螺 旅 桨 知识 ， 历 史 ， 设 计 的 网 站 heliciel。 


桨 叶 的 平衡 


le 所 以 其 旋转 平衡 是 一 个 很 重要 的 指标 。 如 果 桨 叶 有 一 头 重 一 头 

双 ， 或 者 一 侧 轻 一 侧重 等 不 平衡 问题 ， 那 么 在 旋转 时 融会 产生 左右 /前 后 晃动 等 问题 。 这 样 不 
eee 而 且 还 可 能 会 损坏 电机 造成 航模 飞机 炸 机 。 一 般 的 桨 叶 都 已 经 进行 过 目 平 
衡 测试 ， 对 于 要 求 高 的 场合 也 可 以 自己 调节 桨 叶 的 目 平衡 。 下 面 是 一 种 弟 见 的 测试 目 平衡 的 
工具 。 


| 


WE_ 本 
当然 ， 对 于 像 Crazepony 这 样 的 小 四 轴 ， 一 般 束 很 少 考虑 桨 叶 目 平衡 问题 。 





浆 叶 和 电机 的 组 合 





Crazepony 开 音 四 轴 飞 行 坪 








不 同 的 桨 叶 和 电机 (KV 值 不 一 样 ) 能 够 形成 不 同 的 动力 组 合 ， 适 合 于 不 同 的 航模 飞机 和 应 用 


场景 。 


无 刷 电 机 绕 线 忠 数 多 的 ，KV 值 低 ， 最 局 输出 电流 小 ， 但 扭力 大 。 达 到 同样 的 推力 ， 要 比 高 KV 
值 的 剩 电 ， 所 以 四 轴 飞 行 器 多 使 用 小 KV 的 电机 。 


无 刷 电 机 绕 线 臣 数 少 的 ，KV 值 高 ， 最 高 输出 电 注 大 ， 但 扭力 小 。 同 样 的 设备 重量 (电机 、 电 
调 、 电 池 ) ， 得 到 的 最 大 推力 要 高 过 低 KV 值 的 电机 。 


简单 的 说 ， 相 同 的 电机 和 电池 ， 大 KV 值 用 小 的 螺旋 桨 ， 小 KV 值 用 大 的 螺旋 桨 。 相 对 来 说 螺旋 
奖 配 得 过 小 ， 不 能 发 挥 最 大 推力 。 相 对 来 说 螺旋 奖 配 得 过 大 ， 电 机 会 过 热 ， 会 使 电机 退 磁 ， 
造成 电机 性 能 的 永久 下 降 。 


原则 上 ， 更 小 的 KV 值 和 更 大 的 奖 叶 ， 能 够 表现 出 更 好 的 动力 效率 。 也 就 是 说 相同 的 电池 ， 能 
够 飞行 的 时 间 更 长 。 例 如 X5C 这 桩 的 玩具 飞机 ， 电 机 和 桨 叶 由 减速 齿轮 连接 。 减 速 齿轮 降低 
了 电机 的 KV 值 ， 有 更 好 的 动力 效率 。Crazepony 现 在 使 用 30000 转 /分 钟 的 空心 杯 电 机 ,， 
75mm 桨 叶 。 当 配 各 350mAh 电 池 时 ， 能 够 飞行 4-5min 左 右 。 在 电机 和 桨 叶 的 动力 效率 组 合 方 
面 ， 应 该 还 有 进步 的 空间 。 


扩展 - 木 桨 的 改 事 


木 桨 在 人 类 航空 早期 扮演 了 非常 重要 的 角色 。 一 战 时 期 的 很 多 飞机 都 是 使 用 的 木 桨 ， 后 来 才 
逐渐 航 铁 桨 取代 。 下 面 是 那个 时 候 木 桨 的 一 坚 珍 贵 图 片 。 
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更 多 天 于 木 桨 的 知识 ， 参 考 (Asite dedicated to the preservation of early 
wooden airplane propellers )。 


飞行 器 控制 器 一 一 主 控 MCU 


作者 : nieyong 





四 轴 的 灵 现 飞 控 


飞 控 是 四 轴 的 灵 瑰 。 那 么 什么 是 飞 控 呢 ? 飞 控 其 实 融 是 四 轴 飞 行 器 的 电子 控制 部 分 ， 包 括 传 
感 句 部 分 惯性 导航 模块 和 控制 部 分 的 MCU。 


四 轴 飞 行 器 相对 于 常规 航模 来 说 ， 最 复杂 的 就 是 电子 部 分 。 可 以 和 其 它 两 种 常见 的 航模 固定 
愤 以 及 直升机 比较 一 下 。 在 常规 固定 翼 航 模 上 ， 陀 螺 仪 并 非常 用 器 件 。 相 对 操控 难度 大 点 的 
丰 升 级 航模 ， 如 果 不 做 目 动 稳定 系统 ， 也 只 是 锁 尾 才 用 到 陀螺 仪 。 四 轴 飞 行 右 则 必须 配 各 陀 
曙 仪 ， 这 是 最 基本 要 求 ， 不 然 无 法 飞行 ， 更 谈 不 上 飞 稳 了 。 不 但 要 有 有， 还 得 是 3 轴 (X、Y、2Z) 
都 得 有 ， 这 是 四 轴 飞 行 器 的 机 械 结 构 、 动 力 组 成 特性 决定 的 。 在 此 基础 上 再 辅 以 3 轴 加 速度 传 
感 器 ， 这 6 个 自由 度 ， 就 组 成 了 飞行 姿态 稳定 的 基本 部 分 ， 也 是 关键 核心 部 分 惯性 导航 模块 ， 
简称 IMU。 飞行 中 的 姿态 感 测 全 靠 这 个 IMU 了 ， 可 见 它 是 整 架 模型 的 核心 部 件 。 


IMU 感 知 飞 行 器 在 空中 的 姿态 ， 将 数据 送 给 处 理 嚣 MCU。 处 理 嚣 MCU 将 根据 用 户 操 作 的 指 
信 ， 以 及 IMU 数 据 ， 通 过 飞行 算法 控制 飞行 器 的 稳定 运行 。 由 于 有 大 量 的 数据 需要 计算 ， 而 且 
高 要 实时 性 极 高 的 控制 ， 所 以 MCU 的 性 能 也 决定 了 飞行 器 是 否 能 够 飞 得 足够 稳定 ， 有 灵活。 


本 篇 文章 只 讲 飞 控 的 MCU 部 分 ， 料 有 另外 一 篇 文章 《 飞 控 一 一 传感器 》 讲 解 IMU 部 分 内 容 。 


主 控 MCU STM32 


Crazepony 的 主 控 MCU 选 用 的 是 意 法 半导体 的 STM32f103T8U6， 为 32 位 ARM Cortex-M 内 
核 ， 最 高 72MHz。 关于 为 什么 会 选用 这 片 MCU， 在 CamelGo 的 博客 我 和 Crazepony 的 那 点 事 
儿 (2) 中 有 这 么 一 段 摘 述 。 





佛经 在 犹豫 用 TI 的 430 系 列 单片机 还 是 意 法 半 导 的 STM32。 那 是 在 我 大 二 的 时 候 ， 从 来 没 
有 接触 过 STM32， 以 前 都 是 用 51 单 片 机 和 TI 的 msp430 系 列 单片机 。 好 吧 ， 我 承认 了 ， 我 
做 Crazepony 其 实 是 融 是 为 了 学 习 STM32 的 ， 没 有 买 过 STM32 相 关 的 开发 板 ， 丈 这 人 么 简 
单 粗暴 大 刀 阔 和 低 的 开始 了 我 的 STM32 之 族 .… 


最 终 选 择 用 STM32 当 然 还 有 其 他 原因 ，TI 公 司 的 MSP430 系 列 都 是 基于 低 功 耗 在 做 文 
草 ， 作 为 移动 消费 电子 ， 对 电源 续航 能 力 要 求 比较 高 的 场合 比较 适用 。 


之 所 以 选择 STM32F103T8U6 作 为 Crazepony 的 主 控 心 片 。 首 先 因 为 他 是 crotex-M3 内 
核 ， 继 承 了 ARM 的 优良 性 能 ， 主 频 能 跑 到 72MHz，3 个 通用 定时 器 ，1 个 高 级 定时 器 ，7 
通体 DMA 皖 制 妖 ， 而 且 总 线 接口 资源 丰富 ; 其 次 是 因为 它 VFQFPN36 的 封 儿 ， 只 有 
6mm*6mm 的 占 地 面积 ,对 这 个 寸土 寸 金 的 项 目 来 说 简 军 太 赞 了。 这么 高 的 性 价 比 ， 当 然 
让 我 选择 了 他 作为 主 控 。72MHz 虽 然 生 不 了 孩 纸 ， 但 是 足以 处 理 除了 图 像 之 外 的 大 部 分 
ET 


主 控 选 型 需要 考虑 的 问题 


CamelGo 说 是 误 打 误 撞 束 选用 了 STM32 作 为 主 控 MCU， 其 实 真 正在 选 型 时 人 息 ， 有 很 多 问题 是 
需要 我 们 考虑 的 ， 下 面 列 举 出 几 个 最 第 见 的 问题 。 


。 自 先 是 MCU 的 性 能 ， 最 重要 的 指标 融 是 主 频 。 这 直接 决定 MCU 计 算 的 快慢 。 四 轴 飞 行 器 
有 很 多 来 自 IMU 的 数据 需要 人 处理 ， 而 且 还 有 复杂 的 控制 算法 ， 如 果 MCU 的 性 能 不 够 ， 那 
么 将 直接 限制 飞 控 只 能 够 处 于 一 个 比较 初级 的 阶段 ， 无 法 完成 更 加 复杂 的 功能 和 精准 的 
控制 ; 

。 MCU 的 接口 也 很 重要 。MCU 是 整个 四 轴 飞 行 器 的 大 脑 ， 几 乎 所 有 的 数据 都 要 连接 到 它 上 
面 。 例 如 I2C 总 线 个 数 ，DMA 通 道 数目 ，GPIO 数 据 等 等 ; 

。 正如 博客 中 提 到 的 ，MCU 的 尺寸 大 小 也 是 值得 考虑 的 因素 ; 

。 另外 束 是 这 个 MCU 的 开发 是 否 简单 ， 拉 术 资 源 的 支持 是 否 足 够 多 。 这 对 于 一 个 DIY 的 开 
源 四 周 飞行 器 也 很 重要 ; 


综合 了 这 些 因素 ， 我 们 选择 了 STM32 这 片 MCU 作 为 我 们 的 主 控 MCU。 我 们 也 高 兴 的 看 到 ， 很 
多 国内 国外 的 四 轴 爱 好 者 也 选择 了 这 一 片 MCU。Crazepony 不 再 孤独 ! 


关于 ARM Cortex-M 


由 于 STM32 使 用 的 是 ARM Cortex-M 架 构 ， 所 以 这 里 有 必要 做 一 点 ARM Cortex 的 普及 。 

ARM 公 司 在 经 典 处 理 器 ARM11 架 构 之 后 ， 为 了 给 不 同 需求 的 CPU 厂商 提供 服务 ， 之 后 的 内 核 
染 构 命名 都 改 为 Cortex， 并 分 成 了 A.,R,M 三 类 ,也 即将 ARM 的 三 个 字母 拆 分 为 三 个 架构 的 名 ， 
代表 着 不 同 的 发 展 方向 : 


。 人 A 系列 处 理 器 可 托 宦 丰富 的 OS 平台 和 位 应 用 两 提供 全 方位 的 解决 方案 ， 诸 如 低 成 本 手 
机 、 数 字 电 视 、 机 顶 盒 、 打 印 机 、 服 务 器 等 。 
。 R 和 有 系列 为 实时 义理 器 ， 要 求 可 靠 性 、 可 用 性 、 可 维护 性 和 实时 响应 的 散人 陈 系 统 提供 解决 


方案 。 


。 M 条 列 是 一 系列 可 向 上 兼容 的 高 效能 、 易 于 使 用 的 处 理 器 ， 这 些 处 理 器 冒 在 帮助 开发 者 满 
足 将 来 髓 入 式 的 需要 ， 这 些 需 要 包括 低 成 本 、 不 断 增 加 的 连接 、 代 码 改善 移植 等 。M 系 列 
主要 应 用 在 智能 测量 、 人 机 接口 设备 、 汽 车 电子 、 工 业 控 制 、 大 型 家 电 等 。 


所 以 ， 我 们 的 STM32 使 用 的 Cortex-M3 内 核 ， 融 属于 ARM 的 M 系 列 ， 主 要 针对 姐 和 人 陈 产 品 需 
求 而 设计 的 。 下 面 是 一 张 Cortex-M3 的 内 核 架 构图 。 
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在 《飞行 控制 器 一 一 主 控 MCU》 一 文 的 四 轴 的 灵魂 一 一 飞 控 章 节 中 已 经 提 到 ， 飞 控 是 由 传 感 
器 部 分 〈 即 惯性 导航 模块 ，IMU) 和 控制 部 分 MCU 组 成 。 这 篇 文章 我 们 将 重点 讲 讲 传感器 部 
分 的 知识 。 

四 轴 飞 行 器 的 传感器 就 是 用 来 感知 飞行 器 在 空中 的 姿态 和 运动 状态 ， 这 有 个 专 有 名 词 叫做 运 
动感 测 追 踪 ， 瑞 文 Motion Tracking。 在 消费 电子 市 场 ， 运 动感 测 技术 主要 有 四 种 基础 运动 传 
感 器 ， 下 面 分 别 说 明 其 进行 运动 感 测 退路 的 原理 。 





加 速 器 (G-sensors) 


加 速 右 可 用 来 感 测 线性 加 速度 与 倾斜 角度 ， 单 一 或 多 轴 加 速 器 可 感应 结合 线性 与 重力 加 速度 
的 幅度 与 方向 。 仿 加速 器 的 产品 ， 可 提供 有 限 的 运动 感 测 功能 。 例 如 ， 含 加 速 器 的 产品 ， 可 
在 固定 方位 ， 感 应 绕 癌 至 横 同 的 移动 ， 因 此 ， 加 速 器 主要 使 用 于 与 重力 方向 有 关 的 感 测 产品 
中 ， 可 提供 如 将 手机 的 纱 同 蒙蒙 转换 为 村 内 等 的 简单 功能 。 


mh 、 
C 螺 仪 (Gyros) 

陀螺 仪 是 利用 高 速 回 转 体 的 动量 矩 人 敏感 壳 体 相 对 惯性 空间 绕 正 交 于 自转 轴 的 一 个 或 二 个 轴 的 
角 运 动 检测 妆 置 。 利 用 其 他 原理 制 成 的 角 运 动 检 测 妆 置 起 同样 功能 的 也 称 陀 螺 仪 。 


陀螺 仪 可 感 测 一 轴 或 多 轴 的 施 转 角速度 ， 可 精准 感 测 目 由 空间 中 的 复 杀 移动 动作 ， 因 此 ， 陀 
螺 仪 成 为 妃 蹊 物体 移动 方位 与 旋转 动作 的 必要 运动 传感器 。 不 像 加 速 右 与 电子 罗盘 ， 陀 螺 仪 
不 须 信 助 任何 如 重力 或 磁场 等 的 外 在 力量 ， 能 够 目 主 性 的 发 挥 其 功能 。 


更 加 详细 的 资料 ， 参 考 MPU6050 使 用 相关 的 篇 章 。 
电子 罗 意 (E-Compasses) 
电子 罗 瘟 也 叫 数 字 指 南 针 ， 磁 力 计 ， 是 利用 地 磁场 来 定 北极 的 一 种 方法 。 古 代称 为 罗 经 ， 现 


代 利 用 先进 加 工 工艺 生产 的 磁 阻 传 感 右 为 罗盘 的 数字 化 提供 了 有 力 的 帮助 。 现 在 一 般 有 用 磁 
阻 传感器 和 磁 通 门 加 工 而 成 的 电子 罗盘 。 


电子 罗盘 可 和 硬 由 地 球 的 倍 场 来 感 测 前 进 方向 。 运 用 电子 罗盘 的 消费 性 电子 产品 应 用 ， 包 合 在 
手机 的 地 图 应 用 程序 显示 正确 方向 ， 或 为 导航 应 用 程序 提供 前 进 方 向 数据 。 然 而 ， 电 子 设 各 
或 建筑 材料 的 磁场 干扰 ， 上 比 地 球 侯 场 来 得 强 ， 导 致电 子 罗 禹 传感器 的 输出 值 ， 较 容易 受到 各 
种 环境 因素 的 影响 ， 尤 其 在 室内 更 是 如 此 ， 因 此 ， 电 子 罗 和 总 须 要 透 过 频繁 的 校正 ， 才 能 维持 
前 进 方向 数据 的 准确 度 。 


压力 传感器 (Barometers) 


压力 传感器 又 叫做 气压 计 ， 会 藉 由 气压 的 变化 来 感 测 物体 的 相对 与 绝对 高 度 ， 常 被 运用 于 和 与 
运动 、 健 身 、 方 位 推测 等 应 用 有 关 的 消费 性 产品 中 ， 人 例如， 可 感 测 使 用 者 的 移动 层 楼 ， 调 整 
地 信 息 。 


Z 山 

微机 电 条 统 (MEMS) 

微机 电 系 统 (MEMS, Micro-Electro-Mechanical System) 是 一 种 先进 的 制造 技术 平台 。 微 机 
电 有 系统 是 微米 大 小 的 机 械 有 系统 ， 是 以 半导体 制造 技术 为 基础 发 展 起 来 的 。 


在 我 们 的 四 轴 飞 行 器 上 用 到 的 是 传 感 MEMS 分 文 。 传 感 MEMS 技 术 是 指 用 向 电子 微机 械 加 工 
出 来 的 、 用 敏感 元 件 如 电容 、 压 电 、 压 阻 、 热 电 厅 、 谐 振 、 隐 道 电 流 寺 来 感受 转换 电信 号 的 
刁 件 和 系统 。 


我 们 使 用 的 加 速度 陀螺 仪 MPU6050， 电 子 罗 意 HMC5883L 都 是 微机 电 有 统 。 


crazepony 传 感 问 


Crazepony 使 用 传感器 MPU6050， 集 成 了 3 轴 陀 螺 仪 和 3 轴 加 速度 传感器 。 





Crazepony 开 源 四 轴 飞 行 赴 


Crazepony 采 用 的 是 最 弟 用 的 MPU6050 陀 螺 仪 加 速度 计 一 体 必 片 ， 成 本 不 超过 20 元 ， 对 
小 四 轴 来 说 ， 它 的 精度 和 性 能 绰绰有余 了 〈 当 我 听 说 教研 宇 症 兄 用 的 一 颗 传 感 器 梨 片 卖 
1W+ 时 ， 我 整个 人 都 不 好 了 ..) ，MPU6050 在 这 个 价位 里 面 几乎 是 占有 绝对 的 性 价 比 优 
势 。 首 先 ， 它 将 陀螺 仪 和 加 速 计 整合 在 一 个 片上 ， 通 过 IC 总 线 给 出 六 个 维度 的 ADC 值 ; 
其 次 ， 必 片 本 上身 提供 一 个 “从 "1C 搂 口 ， 供 用 户 搂 第 三 方 的 IIC 右 件 ， 一 般 选 择 是 接 一 个 电 
子 罗 盘 ， 如 HMC5883L, 构 成 一 个 9 轴 的 输出 的 姿态 模 组 ,现在 MPU9150 已 经 束 心 病 狂 的 把 
电子 罗 瘟 功能 也 整合 在 片上 了 ,但 是 要 买 60+ 元 ; 最 后 ， 这 颗 芯 片 内 部 集成 了 一 个 

DMP (Digital Motion Processor) 处 理 器 ， 这 是 最 让 我 爱不释手 夜 不 能 法 的 一 个 功能 , 直 
接 硬 件 解 算 四 元 数 , 从 某 种 程度 上 说 解放 了 20% 的 主 控 资源 


在 crazepony 上 ，MPU6050,HMC5883 传 感 器 之 间 的 连接 如 下 图 所 示 。 
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航模 算 控 磊 


作者 : nieyong 


常见 的 无 线 遥 控 按 照 使 用 技术 不 同 ， 主 要 有 红外 遥控 和 2.4G 遥 控 。 红 外 遥控 有 方向 范围 窒 ， 
距离 短 等 特点 ， 所 以 航模 遥控 器 基本 上 都 是 使 用 2.4G 无 线 遥 控 。 我 们 知道 蓝牙 ，wifi， 
ZigBee 等 都 是 采用 的 2.4G 频 段 ， 那 么 这 个 又 有 什么 差别 呢 ? 首先 我 们 需要 对 2.4GHz 无 线 技 术 
以 及 标准 做 一 个 简单 的 介绍 。 


2.4GHz 无 线 扩 术 简介 及 其 标 ， 


2.4GHz 无 线 技 术 如 今 已 经 成 为 了 无 线 产 品 的 主流 传输 护 术 。 所 谓 的 2.4GHz 所 指 的 是 一 个 工作 
频段 2400M-2483M 泄 围 ， 这 个 频段 是 全 世界 免 申 请 使 用 。 背 见 的 Wiff， 蓝 牙 ，ZigBee 都 是 使 
用 的 2.4G 频 率 段 。 


Wifi， 蓝 牙 ，Zigbee 都 是 基于 2.4GHz 的 ， 只 不 过 他 们 采用 的 协议 不 同 ， 导 致 其 传输 速率 不 
同 ， 所 以 运用 的 范围 束 不 同 。 同 样 是 采用 2.4G 频 率 作 为 载波 ， 但 不 同 的 通讯 协议 衍生 出 的 通 
讯 方 式 会 有 着 天 壤 之 别 ; 仅仅 在 传输 数据 量 上 ， 就 有 着 从 1M 每 秒 到 100M 每 秒 的 差别 。 详 见 下 
面 的 2.4GHz ISM 频 段 无 线 信 号 比较 图 。 


802.11b 


OMIHz 一 可 1MHz Mr 22MHz 一 1MHz 3Hz 





2.4G 无 线 通 信 模 块 


2.4G 无 线 通信 模块 (英文 : 2.4Ghz RF transceiver / receiver module) 工作 在 全 球 免 申请 ISM 
频道 ， 频 率 范 围 是 2400MHz-2483MHz。 实 现 开 机 目 动 扫 频 功能 ， 共 有 50 个 工作 信道 。 市 面 

上 的 航模 遥控 回 基 本 上 都 是 使 用 2.4G 无 线 通 信 模 块 ， 对 应 遥控 右 会 配置 一 个 接收 机 。 和 遥控 需 

(发 射 机 ) 和 接收 机 需要 配对 使 用 ， 不 同 厂商 的 不 能 够 兼容 ， 因 为 使 用 的 收发 芯片 以 及 协议 

可 能 不 一 样 。 


Crazepony 使 用 的 2.4G 无 线 射频 芯片 NRF24L01 作 为 无 线 控制 。 在 飞机 上 我 们 将 NRF24L01 
作为 搂 收 部 分 做 到 PCB 板 上 ， 在 遥控 右上 我 们 使 用 基于 NRF24L01 心 片 的 模块 ， 方 便 插 氢 跟 
换 。 


crazepony 的 2.4G 模 块 


Crazepony 使 用 的 是 单 片 2.4G 无 线 射 频 收 发 必 片 NRF24L01。 天 于 为 什么 会 选用 这 片 IC， 在 
CamelGo 的 博客 我 和 Crazepony 的 那 点 事 儿 (2) 中 有 这 人 么 一 段 描述 。 


数据 通信 这 块 ， 也 没什么 特别 要 考虑 的 ， 短 距离 高 速 通信 且 免 费 这 一 点 要 求 惑 限制 了 只 
能 选择 2.4GHz 这 个 频段 ， 在 这 个 频段 出 了 很 多 优秀 的 必 片 三 两 。 在 学 生 时 代 ， 我 用 得 最 
多 是 Nordic 公 司 的 NRF24L01 这 个 系列 的 收发 一 体 心 片 ， 由 于 刚 开 始 着 手 和 启动 Crazepony 
这 个 项 目 时 ， 我 只 会 这 颗 操作 心 片 ， 本 看 方便 的 原则 ， 所 以 很 自然 的 选择 了 这 颗 它 (后 
来 发 现 国外 一 个 团队 bitcraze 也 用 的 这 个 系列 的 心 片 时 ， 还 是 有 点 小 激动 的 ) 


市 面 上 有 基于 NRF24L01 心 片 的 模块 ， 有 统一 的 标准 接口 。 在 遥控 器 上 ， 我 们 就 曾 接 使 用 了 这 
个 模块 ， 用 来 和 飞 控 上 的 NRF24L01 进 行 通信 。 我 们 标 配 的 模块 如 下 图 所 示 ， 控 制 的 距离 在 
20m 左 右 。 





遥控 器 上 也 可 以 使 用 带 有 PA (功率 放大 ，power amplifier) 的 NRF24L01 模 块 ， 带 有 鞭 状 天 
线 ， 我 们 实测 能 够 达到 100m 的 控制 距离 。 





下 图 为 使 用 带 有 PA 的 2.4G 模 块 遥控 器 的 实物 图 。 





市 场 上 般 模 双 控 器 介绍 


进口 如 控 ， 有 名 的 品牌 有 JR/FUTABA/SANWA 等 。 


。 油 动 版 (标准 接收 机 ) ， 遥 控 距 离 在 600~800 米 
(4VF/4EX/6EX/MAX66/RD6000/VG400) ， 一 般 使 用 FM/PPM 模 式 
e 电动 版 (微型 接受 机 ) ， 遥 控 距 离 在 400~500 米 (一 次 变频 版 ) 700~1000 米 (二 次 变 


频 ) 
。 高 级 遥控 器 ， 象 FF9/JR9X2/JR12/T12/T14，PCM 版 二 次 变频 接收 机 ， 最 远 有 
1.5KM~2KM 





国产 遥控 右 ， 最 剖 见 的 为 天 地 飞 ， 英 文 WFLY。 


。 天 地 飞 6 通 ， 一 次 变频 版 接收 机 一 般 遥 控 距 离 在 300~400 米 ， 这 种 小 型 接收 机 一 般 只 适用 
于 电动 飞机 ， 装 到 油 机 上 面 有 一 定 危险 。 

。 天 地 飞 8，9 通 ， 遥 控 距 离 600~800 米 ， 二 次 变频 版 ， 可 以 飞 油 动 飞机 ， 电 动 飞 机 ， 但 飞 
汽油 机 有 和 危险。 


直 


| 





国产 双 控 与 进口 各 控 的 差距 区 别 在 于 ， 一 是 无 线 电 技术 上 的 差距 ， 另 一 方面 国产 的 研发 机 构 
太 少 ， 没 有 经 过 长 时 间 的 产品 测试 。 国 产 遥 控 器 用 的 都 是 比较 便宜 的 电子 元 件 ， 所 以 成 本 比 
较 低 ， 特 别 是 接收 机 ， 接 收 机 的 必 片 ， 好 接收 机 都 是 进口 必 片 ， 所 以 很 稳定 ， 程 序 编写 比较 
好 ， 便 家 的 接收 机 必 片 比较 便宜 ， 所 以 容易 出 事 。 一 个 很 简单 的 例子 ， 遥 控 器 上 面 的 电位 
器 ， 国 产 设备 用 得 是 国产 电位 器 一 般 寿 命 在 10~30 万 次 ， 进 口 设备 的 电位 器 ， 像 FUTABA 是 台 
湾 产 的 可 以 达到 100 万 次 ， 这 样 直 接 影 响 遥 控 器 的 寿命 。 一 般 认 为 遥控 器 的 做 工 方面 JR 遥控 器 
最 好 ， 线 路 布局 各 方面 都 很 好 ， 特 别 是 目前 只 有 JR 遥控 器 配 有 保险 丝 如 果 爱 好 者 不 小 心 短 路 
了 ， 只 需要 更 换 保 险 丝 就 可 以 ， 比 较 人 性 化 ， 更 重要 的 是 JR 遥控 器 全 部 是 在 日 本 ， 马 来 西亚 
制造 ， 品 质 有 所 保证 。 FUTABA 大 众 型 遥控 堪 现 在 比较 普 吉 ， 现 在 FUTABA 的 低 病 迁 控 吉 都 
是 在 国内 产 的 ， 接 收 机 是 台湾 产 的 ， 所 以 遥控 器 这 东西 一 份 价格 一 分 沉 。 模 友 按 照 自己 的 经 
济 能 力 去 选 购 融 可 以 了 ， 千 万 不 能 擎 比 ， 选 择 适 合 自己 的 都 可 以 。 


现在 国产 遥控 器 的 三 家 越 来 越 多 ， 价 格 的 优惠 使 得 航模 的 门槛 越 来 越 低 ， 所 以 有 一 歌 适 合 
己 的 遥控 器 是 广大 模 友 的 心愿 ， 广 大 模 友 按照 目 己 的 经 济 实力 合理 选 购 属于 目 己 的 避 控 器 。 


拥有 一 个 遥控 右 ， 能 人 否 用 来 控制 Crazepony 四 轴 飞 
行 圳 


要 使 用 原 有 的 遥控 器 控制 Crazepony 四 轴 飞 行 器 ， 需 要 满足 下 面 两 个 条 件 。 


。 球 控 器 是 使 用 和 crazepony 飞 机 上 2.4G 射 频 接 收 心 片 NRF24L01 一 样 的 发 射 心 片 ， 或 者 相 
兼容 的 心 片 。 

需要 知道 遥控 堪 的 数据 编码 格式 。 很 多 厂商 原则 上 是 不 会 公开 和 遥控 堪 使 用 的 数据 编码 格 
式 的 。 这 融 需 要 对 该 厂商 遥控 器 的 编码 进行 破解 。 


例如 crazyflie 束 广 持 ESky 的 遥控 器 ， 因 为 该 遥控 器 的 编码 锌 大 午 破 解 并 且 公 开 。 所 以 有 人 专 
门 争 对 这 个 提供 了 接收 机 代码 包 ， 叫 做 Esky Protocol， 其 实 就 是 ESky 公 司 遥 控 器 使 用 的 通信 
协议 。 只 要 在 飞 控 疹 将 遥控 器 的 数据 解析 出 来 ， 融 可 以 使 用 ESky 航 模 公 司 的 遥控 器 进行 控 
制 |。 
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nttp: F Per Ww. re-recyelerceam 
关于 ESky 公 司 的 2.4G 遥 控 右 设备 的 通信 协议 ， 参 考 ArduinoRCLib 项 目 中 的 摘 述 。 


The Esky 2.4 GHz equipment uses the Nordic NRF2401AG in both the transmitter and 
receiver. Acompatible alternative to this chip is the NRF24LO1+ (which is widely 
avalilable). 


天 于 接收 机 的 输出 和 PPM/PCM 编 码 


todo 


关键 字 : Arduino PPM 


HI CH CHSACGHH CHS 蝶 HI 刁 HI CH CHSACGHH CHS CH 


| 避 
SOx So Ox Sox T1000 SOx End of frome SOx So Ox SO O00 So End of 





天 于 巡 控 曲线 问题 


很 多 新 手 反 应 ， 航 模 不 好 控制 。 其 实 这 是 有 原因 的 ， 其 中 最 大 的 一 点 就 是 关于 乏 控 曲线 的 问 
题 ， 而 其 中 又 以 油门 曲线 最 为 有 代表 性 。 


目的 是 把 直线 变化 的 油门 ， 变 为 曲线 变化 ， 以 此 提供 不 同 的 飞行 模式 。 我 们 以 最 简单 的 3 点 曲 
线 来 说 明 ， 我 们 把 发 射 机 油门 遥 杆 从 下 压 痕 ， 中 段 ， 上 顶 病 分 为 3 个 点 ， 普 通 的 发 射 机 对 应 的 
油门 量 分 别 是 0%，50%，100%， 如 果 具 有 油门 曲线 的 发 射 机 ， 则 可 对 这 3 个 点 单独 进行 设 
定 。 


比如 ， 我 们 将 下 医 靖 的 0% 设 定 为 100%。 这 时 ， 油 门 摇 杆 的 位 置 在 中 段 时 油门 量 为 50%， 辐 
上 向 下 推动 油门 遥 杆 都 是 不 断 的 增加 油门 量 直 到 100% 油 门 。 这 时 我 们 看 到 的 是 一 个 V 字 形变 
化 的 油门 曲线 了 (这 是 3D 模 式 的 油门 变化 要 求 )。5 点 曲线 就 是 在 3 点 之 间 插 入 2 个 点 ， 以 提供 更 
接近 曲线 的 平滑 设 定 。 当 然 还 有 一 些 高 端的 遥控 器 提供 了 7 点 甚至 更 多 的 设 定点 。 那 么 多 少 合 
适 呢 ， 对 于 世界 级 的 比赛 其 实 5 点 或 以 上 融 已 经 足够 了 ! 


Crazepony 原 理 讲 解 


本 章 主 要 讲解 Crazepony 的 人 硬件 原理 和 软件 框架 。 从 中 可 以 看 到 我 们 的 主要 设计 思路 。 同 时 ， 
我 们 将 元 器 件 选 型 和 开发 经 验 进 行 了 总 结 ， 方 便 大 家 DIY 属 于 自己 的 四 轴 飞 行 器 ， 并 且 少 走 我 
们 鲁 经 走 过 的 从 路。 
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Crazepony 直 件 总 览 及 选 型 说 明 


作者 : nieyong 


我 们 暂时 不 提供 桨 叶 / 空 心 杯 电 机 /电池 等 易 损 耗 配件 的 购买 。Craze 团 队 整 理 了 部 分 淘宝 上 的 
购买 地 址 及 注意 事项 ， 大 家 可 以 自行 购买 。 


电机 & 桨 叶 


720 有 刷 空 心 杯 电机 ， 中 心 轴 直径 1mm。 淘 至 购买 地 址 : 地 址 1。 





直径 为 75mm 浆 叶 ， 浆 叶 中 心 孔 直径 为 1Imm， 正 好 配 中 心 轴 直径 为 1Imm 的 720 电 机 。 淘 宝 购买 
地 址 : 地 址 1。 





电 闻 


Crazepony 飞 机 电池 为 650mAh，3.7V，25C 航 模 电 池 。 le 择 350mAh 电 池 ， 购 买 
地 址 (建议 自己 上 淘宝 上 寻找 ， 这 个 链接 是 阿里 巴巴 链接 ， 需 要 批量 拿 货 ) 。 


购买 时 需要 注意 电池 接口 。 


2.4G 无 线 射 频 


Crazepony 机 有 身上 使 用 2.4G 无 线 射 频 收 发 必 片 nRF24L01。 





遥控 器 上 使 用 2.4G 无 线 射频 模块 ， 根 据 遥 控 距 离 的 不 同 ， 有 下 面 两 种 可 以 选择 。 
加 功率 放大 (PA) 的 鞠 状 天 线 ， 最 大 发 送 功率 20dBm， 可 以 遥控 距离 100 米 。 购 买 地址 。 





不 加 PA 的 发 射 模块 ， 最 大 发 射 功率 0dBm， 可 以 遥控 距离 20 米 。 购 买 地 址 。 





主 控 MCU (单片机 ) 


主 控 为 STM32 的 F10 和 系列 ，STM32F103T8U6，ARM Cotex-M3 内 核 ，72MHz 主 频 ，128KB 存 
储 空间 ，BGA 封 装 。 





电机 驱动 


SIl2302，N 沟 道 增 强 型 MOS， 导 通电 阻 82mQO，2.2v 低 GS 电 压 。 


取 螺 仪 加 速度 计 


MPU6050， 三 轴 陀 螺 仪 + 三 轴 加 速度 计 ， 目 带 DMP 四 元 数 输出 ， 内 部 温度 补偿 。 





气压 计 


MS5611，10cm 精 度 气 压 计 。 





电子 罗 意 《合力 计 ) 


HMCLC5883L， 电 于 罗盘 。 





蓝牙 透 传 模 块 


HM-06 


淘宝 购买 地 址 ， 仅 此 一 家 。 


USB 转 串口 心 睛 
cp2102，USB 转 串口 必 片 ， 用 于 固件 下 载 ， 参 效 调试 。 
锂电 池 元 电 官 理 


LT4054， 锂 电 充电 管理 心 片 。 


摇 杆 电位 姻 


淘宝 购买 地 址 。 


我 们 对 油门 授 杆 的 要 求 是 推 左右 目 动 回 中 ， 推 上 下 不 回 ， 可 停留 在 另 意 位 置 。 根 据 这 个 要 
求 ， 我 们 只 找到 了 这 种 拆 机 的 摇 杆 物料 。 


5.1 版 本 即 以 后 ， 油 门 拉杆 使 用 目 动 回 中 的 电位 器 ， 不 再 使 用 上 面 的 拆 机 操 杆 ， 所 有 操 杆 都 是 
新 物料 。 


陶 压 天 线 


飞机 上 2.4G 使 用 了 陶 资 天线 ， 型 号 为 : rainsun An9520-245。 


Crazepony 硬 件 原 理 讲 解 


原 圭 图 设计 


Crazepony-ll( 第 4 版 /4.1 版 ) 硬 件 组 成 


。 主 控 : STM32f103T8U6 

e。 姿态 传感器 : MPU6050 (3 加 速度 +3 角 速度 ) 

e。 电子 罗盘 : HMC5883L 

e。 无 线 通信 协议 : NRF24L01+ 与 蓝牙 2.1/ 蓝 牙 4.0 透 传 共存 
e。 有 线 通 信 协 议 : CP2102 (USB 转 串口 ) 

e 电机 驱动 : SI2302 场 效应 管 

e 外 部 接口 :标准 mircoUSB 接 口 

e。 电机 : Coreless 高 速 电机 3W 转 /分 钟 

e。 奖 叶 : 46mm 黑 色 正 反 奖 

e。 电池 : 350mAh 25c 航 模 动 力 电池 


Crazepony-ll( 第 4 版 /4.1 版 ) 原 理 图 设计 简介 
单片机 最 小 系统 


单片机 在 任何 一 个 系统 里 面 ， 无 论 他 扮演 什么 角色 。 它 要 正音 工作 ， 都 必须 要 有 一 个 最 小 系 
统 。 下 面 ， 从 最 小 系统 开始 简介 Crazepony : 


Crazepony 开 源 四 轴 飞 行 赴 
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STM32f103TS8U6 





STINS2f110318U6 


STM32 的 最 小 系统 一 般 包 括 : 复位 电路 ， 外 部 时 钟 电路 ， 启 动 模式 选择 电路 ， 电 源 退 偶 电 路 
等 


复位 





查阅 意 法 半 导 的 官方 手册 可 以 知道 ，STM32 系 列 单片机 都 是 低 电 平复 位 。 于 是 采用 如 图 的 主 
流 复 位 电路 作为 Crazepony 主 控 的 复位 电路 
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外 部 时 钟 


官方 手册 有 写 ， 外 部 时 钟 我 们 采用 的 是 8M 无 源 晶振 。 单 片 机 内 部 做 倍 频 ， 系 统 时 钟 最 高 可 达 
到 72M 


启动 模式 
STM32 的 启动 模式 分 为 三 种 ， 可 以 下 面 的 表格 给 出 : 


oo | | ; ] 


由 于 为 了 方便 用 户 调试 和 二 次 开发 ， 所 以 Crazepony 采 用 了 SWD 在 线程 序 调试 接口 和 |ISP 程 序 
下 载 两 种 方式 。SWD 调 试 接口 可 以 使 用 编译 调试 器 在 线 对 程序 进行 仿真 、 调 试 、 下 载 ， 这 对 
开发 人 员 来 说 是 很 方便 的 ， 缺 点 就 是 需要 PC 端 有 一 个 这 样 的 软件 来 支撑 。 串 口 ISP 下 载 方 
式 ， 只 需要 STM32 的 UART1 的 两 个 数据 线 ， 融 能 将 编译 生成 的 .HEX 文 件 烧 写 进 单片机 ， 不 
足 之 处 是 不 能 仿真 程序 。 





关于 启动 模式 的 应 用 ， 在 USB-Serial 处 会 有 介绍 。 
电源 退 偶 


不 仅 是 主 控 最 小 系统 需要 对 电源 退 偶 ， 所 有 的 数字 电路 和 模拟 电路 共存 的 系统 ， 都 需要 对 电 
源 退 偶 。 电 源 退 偶 ， 说 直接 一 点 就 是 将 电源 上 的 噪声 电压 引入 到 地 平面 ， 让 电源 电压 保持 在 
一 个 稳定 的 值 ， 这 样 系统 才 可 能 稳定 工作 。 怎 么 做 呢 ? 用 一 个 大 电容 并 联 一 个 小 电容 。 


Vdd-1 


19 

Vec3.3 27 
Vdd-2 
Vdd_3 


Vss-] 
Vss-2 


18 
GND | es 
ln 6 


VssA 


我 们 都 知道 ， 电 容 对 频率 越 高 的 信号 ， 呈 现 低 阻 特性 ， 对 军 流 呈现 高 阻 特性 。 那 么 电源 上 的 
噪声 对 地 平面 而 言 ， 束 是 一 个 交流 信号 ， 交 流 信号 束 能 通过 电容 到 达 地 平面 ， 而 电源 是 一 个 
直流 ， 电 容 对 他 呈现 出 无 限 大 的 阻力 ， 无 法 通过 。 这 样 ， 我 们 用 示波器 融 可 以 看 到 ， 加 了 退 
偶 电 容 的 电源 会 比 没 加 退 偶 电容 的 电源 ， 波 形 要 稳定 得 多 。 


条 统 电 赣 
RS 
GND 儿 | 
10K 
GND | 
C2 C21 
dl 10uF| 104 





3.7V to Sv 


市 面 上 所 有 的 航模 动力 电池 ， 都 是 3.7V 的 标 称 值 ， 比 此 电压 高 的 电池 ， 都 是 几 个 3.7V 的 电池 
串联 起 来 的 


Crazepony 采 用 了 一 节 动 力 电 池 ， 电 池 电 压 是 3.7V， 而 系统 所 有 攻 片 都 要 求 是 3.3v 供 电 。3.7V 
到 3.3V 只 有 0.4v 的 压 差 ， 我 们 考虑 过 采用 低压 差 的 LDO 稳 压 必 片 输出 ， 但 是 要 知道 ， 四 个 空 
心 杯 电机 转 起 来 以 后 ， 眠 间 电 流 能 达到 3A， 此 时 电池 电 太 会 被 拉 低 到 一 个 LDO 无 法 正常 工作 
的 值 ， 于 是 我 们 后 来 放弃 了 直接 将 电池 接 到 LDO 稳 压 芯片 上 ， 而 是 在 中 间 采 用 一 个 过 渡 的 电 
路 : 一 个 DC-DC 的 升 压 电路 ， 首 先 将 电池 电源 升 到 5V 左 石 ， 再 手 人 LDO 心 片 《MIC5205- 
3.3) 如 图 
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锂电 池 天 电 这 一 块 ， 采 用 的 是 LTC4054， 外 部 电路 简单 ， 一 个 电阻 R7 作 为 序 电 限 流 电阻 ， 充 
电 电 流 最 大 可 达 600mA， 充 电 电流 计算 公式 : IBAT =(VPROG /RPR0G)*1000 。 


R6 作 为 充电 指示 灯 的 限 流 电阻 ， 选 择 几 百 欧姆 就 行 了 。 当 充电 进行 中 ， 引 上 肢 STR 常 低 ， 充 电 
结束 时 ，STR 拉 高 。 对 应 的 状态 束 是 : 充电 时 ，CHG 灯 常 完 ， 却 电 完 成 ，CHG 灯 灭 。 


姿态 传 感 右 
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Crazepony 采 用 的 是 最 部 用 的 MPU6050 陀 螺 仪 加 速度 计 一 体 心 片 ， 成 本 不 超过 20 元 ， 对 小 四 
轴 来 说 ， 它 的 精度 和 性 能 绰绰有余 了 ( 当 我 听 说 教研 宇 病 兄 用 的 一 颗 传 感 器 保 片 卖 1W+ 时 ， 
我 整个 人 都 不 好 了 ..) ，MPU6050 在 这 个 价位 里 面 几 乎 是 占有 绝对 的 性 价 比 优势 。 首 先 ， 它 
将 陀螺 仪 和 加 速 计 整合 在 一 个 片上 ， 通 过 1C 总 线 给 出 六 个 维度 的 ADC 值 ; 其 次 ， 心 请 本 刁 提 
供 一 个 “从 ?1C 接 口 ， 供 用 户 接 第 三 方 的 IC 器 件 ， 一 般 选 择 是 接 一 个 电子 罗盘 ， 如 
HMC5883L， 构 成 一 个 9 轴 的 输出 的 姿态 模 组 ， 现 在 MPU9150 已 经 来 心 病 狂 的 把 电子 罗盘 功 
能 也 整合 在 片上 了 ， 但 是 要 买 60+ 元 ; 最 后 ， 这 颗 心 片 内 部 集成 了 一 个 DMP (Digital Motion 
Processor) 义理 器， 这 是 最 让 我 爱不释手 夜 不 能 几 的 一 个 功能 ， 下 搂 硬 件 解 算 四 元 数 ， 从 茶 
种 程度 上 说 解放 了 20% 的 主 控 资 源 。 


采用 HMC5883L 作 为 机 身 的 电子 罗盘 。 电 子 罗 意 接 到 MPU6050 的 从 IC 总线 (auxda，auxdl) 
上 ， 在 初始 化 MPU6050 时 ， 设 置 成 主 |IC 总 线 与 从 IC 总 线 直 通 ，STM32 可 以 直接 通过 主 |IC 总 
线 访问 从 lIC 总 线 ， 从 而 读 取 HMC5883L 的 数据 。 


数据 更 新 模式 采用 硬件 中 断 模 式 ， 即 MPU6050 和 HMC5883L 都 有 一 个 硬件 中 断 引 脚 MP_INT 
和 HM_INT， 这 样 ， 能 保证 数据 到 来 时 间 的 准确 ， 让 CPU 资源 最 大 化 利用 。 

由 于 电子 罗盘 是 一 个 对 电磁 环境 很 敏感 的 元 件 ， 所 以 在 布局 时 ， 尽 量 将 HMC5883 放 在 一 个 空 
旷 的 地 带 ， 周 围 不 要 有 人 金属， 附近 不 要 有 不 要 有 大 电流 通过 。 


在 这 个 问题 的 处 理 上 ，dji 的 Phantom 系 列 飞 行 器 已 经 有 了 很 好 参考 ，Phantom 系 列 的 电子 罗 
盘 是 放 在 飞机 的 起 洛 架 上 的 ， 可 以 看 出 他 们 的 工程 炳 在 设计 飞行 器 的 时 候 ， 考 虑 问题 是 很 周 
全 的 。 


电机 驱动 


无 刷 电 机 的 操作 相对 来 说 是 比较 腑 烦 的 ， 而 有 刷 电 机 融 是 我 们 小 时 候 玩 的 四 驱车 上 的 那 种 电 
机 ， 搂 上 电 融 能 猛 转 ， 反 看 搂 它 融 反 看 儿 转 ， 融 是 这 人 么 简单 。 


Crazepony 使 用 的 是 有 刷 空 心 杯 电 机 ， 所 以 电机 的 控制 属于 有 刷 直 流 电机 控制 。 相 对 于 无 刷 电 
调 来 说 要 简单 很 多 ， 所 以 电 调 我 们 就 默认 指 无 刷 电 机 的 电 调 ， 而 这 里 只 用 电机 了 驱动 来 代替 。 
Crazepony 采 用 的 是 有 刷 空心 杯 高 速 电机 ， 转 速 在 3W 转 /分 钟 左 右 。 要 了 驱动 有 刷 电 机 ， 很 简 
单 ， 只 需要 将 信号 的 驱动 能 力 增 大 ， 就 能 驱动 有 刷 电 机 了 。 


那么 选择 什么 元 件 来 提供 这 样 的 特性 呢 ?Crazepony 的 电机 驱动 IC 选 型 经 历 了 三 级 管 ， 中 功率 
宰 的 失败 ， 最 后 选用 的 是 场 效 应 和 寺 〈 即 MOSFET) SI2302。 


由 于 笔者 完全 是 由 于 一 种 强烈 的 爱好 选择 了 飞行 器 ， 最 开始 连 有 刷 电 机 和 无 刷 电机 的 物理 结 
构 区 别 都 不 知道 ， 电 调 又 是 哈 ? 傻 傻 分 不 清楚 ..….…… 


从 一 个 几乎 替 基 础 的 状态 去 选择 电机 驱动 芯片 ， 弯 路 是 必须 要 走 的 ， 学 费 是 必须 要 交 
的 。 便 以 为 书 上 学 到 的 东西 马上 就 能 用 ， 马 上 能 转化 为 产品 ， 后 来 发 现 真 的 是 自己 想 多 
了 。 


最 开始 用 的 三 极 管 作为 电机 驱动， 采用 很 经 典 的 共 射 电路 "三极管 工作 在 开关 状态 应 该 束 行 了 
吧 ?" 对 了 用 三 极 管 驱动 的 PCB 板 ， 发 现 电 机 越 转 越 慢 ， 根 本 没劲 。 "也许 是 因为 三 极 管 红 不 了 
大 电流 ， 好 吧 那 我 换个 中 功率 管 吧 ， 集 电极 最 大 6A 电 流行 了 吧 ? "可 以 想象 结果 是 不 行 的 。 





首先 了 解 下 为 什么 三 极 管 作为 简单 的 电机 了 驱动 是 不 可 取 的 方案 : 


。 三 极 管 作 为 一 个 古老 的 半导体 先驱 ， 它 是 以 一 个 放大 器 件 的 姿态 而 出 现 的 ， 它 在 线性 区 
域 特性 集中 ， 人 饱和 和 与 截止 都 是 两 种 极端 的 工作 状态 ， 而 作为 电机 驱动 的 话 ， 我 们 只 能 选 
择 它 的 这 两 种 极 问 工作 模式 ,。 


。 用 三 极 管 作为 大 电流 负载 的 驱动 管 时 ， 不 得 不 考虑 的 是 他 自身 的 管 压 降 对 负载 的 影响 ， 
这 是 很 严重 的 。 自身 耗 散 越 来 越 大 ， 电 机 和 管子 是 串联 关系 ， 电 池 电 压 只 有 3.7V， 电 机 
融 只 能 越 转 越 慢 了 


在 晶体 管家 族 里 面 还 有 一 种 跟 三 极 管 特性 互补 的 ， 所 有 特性 都 集中 在 开关 状态 的 晶体 过 ， 场 
效应 党 ， 即 MOSFET。 通 弟 的 场 效 应 管 完全 导 通 时 ， 源 漏 极 电阻 都 是 mQ 级 别 的 ， 即 它 目 号 的 
耗 散 非 党 小。 用 它 做 为 驱动 泄 再 合 运 不 过 了 。 最 终 选择 了 一 个 SOT23 封 沪 的 , 导 通 电压 Vgs<4v 
的 场 省 (SI2302) ,结果 表现 出 了 很 好 的 驱动 性 能 。 





Notor3 


每 个 场 效 应 时 接 一 个 大 电阻 下 拉 ， 目 的 是 为 了 防止 在 单片机 没 接手 电机 的 控制 权时 ， 电 机 由 
于 PWM 信号 不 稳定 开始 猛 转 。 接 一 个 下 拉 电 阻 ， 保 证 了 场 雪 输入 信号 要 么 是 局 ， 要 么 是 低 ， 
没有 不 确定 的 第 三 种 状态 。 那 么 电机 也 只 有 两 种 状态 。 要 么 转 ， 要 么 不 转 。 主 控 输 出 的 是 
PWM 波 形 ， 用 于 控制 场 效应 管 的 关闭 和 导 通 ， 从 而 控制 电机 的 转动 速度 。 这 束 是 crazepony 
电机 了 驱动 的 原理 。 束 是 这 么 简单 。 


2.4G 通信 
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2p XTAL EMIhz 
Recelver 
Crazepony 在 选择 通信 心 片 上 ， 也 是 选择 了 大 家 熟悉 的 芯片 ，NRF24L01。 我 相信 很 多 朋友 跟 


我 一 样 ， 在 大 学 阶段 玩 过 最 多 的 无 线 忆 片 就 是 它 了 ， 因 为 市 面 上 有 很 多 针对 这 个 必 片 延伸 出 
来 的 各 种 通信 模块 ， 技 术 很 成 熟 ， 也 很 稳定 ， 性 价 比 很 高 。 

我 查阅 了 NRF24L01 的 芯片 手册 ， 官 方 给 出 了 整套 硬件 设计 方案 ， 包 插 天 线 的 设计 ，PCB 阻 抗 
计算 ， 以 及 底层 的 SPI 驱 动 协议 等 等 ， 资 料 很 详细 。 


于 是 我 们 将 这 颗 必 片 画 在 了 机 身上 面 ， 在 天 线 方面 的 选择 上 ， 我 采用 体积 很 小 的 2.4G 陶 冶 
线 ， 这 种 天 线 比 PCB 天 线 拍 地 面积 小 ， 对 这 个 寸土 寸 金 的 小 飞机 而 言 ， 简 下 太 棒 了 。 





USB-Serial 协 议 转 换 


前 面 已 经 说 了 启动 模式 的 切换 会 在 下 载 程 序 时 用 到 。 


Crazepony 在 设计 之 初 ， 束 考虑 到 了 ， 一 般 用 户 PC 机 上 是 不 会 小 像 KEIL 这 种 软件 的 ， 但 是 所 
有 的 PC 机 都 有 USB 接 口 ， 那 么 在 机 身上 集成 一 个 USB-Serial 协 议 转换 必 片 ， 那 么 就 能 够 直接 
用 一 根 micro USB 的 数据 线 〈 就 是 现在 统一 的 安 卓 手机 数据 /充电 线 ) 对 飞机 进行 固件 
(*.HEX) 升级 了 ， 这 种 方式 真是 太 棒 了 。 


试想 ， 你 的 电脑 里 原来 都 是 跟 你 工作 相关 的 文件 或 者 是 软件 ， 今 天 你 买 来 一 台 Crazepony， 里 
面 的 固件 圣 然 已 经 很 优秀 了 ， 但 是 我 们 一 下 在 完善 它 ， 突 然 有 一 天 ， 我 们 各 诉 你 ， 我 们 的 回 
件 升 级 了 ， 你 可 以 选择 更 新 固件 。 那 么 ， 现 在 有 两 种 方式 供 你 选择 来 升级 你 的 飞机 : 第 一 ， 
你 需要 装 一 个 叫做 KEIL 或 者 IAR 或 者 其 他 类 似 的 专业 软件 ， 还 得 在 淘宝 买 一 个 你 看 都 看 不 懂 的 
jlink 调 试 器 。 第 二 ， 你 只 需要 将 你 的 安 卓 手机 线 拿 出 来 ， 插 上 电脑 ， 打 开 我 们 的 一 键 升级 软 
件 。 这 两 种 方式 ， 我 想 大 家 都 会 选择 第 二 种 吧 。 


那么 ， 要 实现 第 二 种 方式 ， 我 们 融 需 要 用 到 启动 方式 的 切换 来 实现 。 





28 Vcc3.3 
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我 们 可 以 看 到 PNP 型 三 极 管 Q5 的 基 极 是 和 复位 按键 连接 的 ，PNP 型 三 极 管 是 基 极 低 电 平 导 
通 。Q5 的 发 射 极 是 和 电源 连接 ， 集 电极 是 和 BOOT0 连 接 。 显 然 ，BOOT0 的 电位 高 低 ， 是 跟 
复位 按键 是 否 按 下 直接 相关 的 ， 同 时 我 们 有 上 面 的 铺垫 也 知道 ，BOOT0=1，BOOT1=1 时 ， 
STM32 从 内 部 闪存 开始 和 启动 ， 用 于 程序 调试 用 。 复 位 按键 按 下 之 前 ，BOOT0=0 (内 部 下 

拉 ) ， 复 位 按键 按 下 以 后 ，BOOT0=1， 复 位 后 ， 间 隅 四 个 时 钟 周期 后 采样 BOOT0 的 电 平 ， 如 
果 是 高 电 平 ， 那 么 进入 调试 模式 ， 开 始 接收 串口 发 送 的 程序 代码 ， 存 放 在 内 部 的 Flash 中 ， 下 
载 完 毕 以 后 ， 坎 件 复位 ， 此 时 复位 按键 肯定 已 经 弹 起 了 ， 四 个 时 钟 周 期 以 后 采样 BOOT0， 此 
时 是 低 电 平 ， 进 入 正常 模式 ， 这 样 束 完成 了 一 次 ISP 下 载 。 


这 样 一 来 ， 机 有 身 和 外 部 的 有 线 接口 融 只 有 一 根 安里 手机 的 标 配 数据 线 micro USB 线 。 它 既是 到 
电线 ， 也 是 调 参 、 烧 写 固 件 的 数据 线 。 这 对 大 妈 来 说 ， 想 必 操 作 也 是 很 简单 的 吧 。 


有 了 USB-Serial 的 转换 ， 那 么 我 们 的 飞机 和 PC 上 位 机 的 通信 融 有 了 必要 的 人 硬件 基础 。 


蓝牙 透 传 模块 
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为 了 让 Crazepony 能 跟 上 智能 机 泛滥 的 步伐 ， 同 时 也 是 为 了 增加 它 的 适应 性 和 降低 成 本 的 考 
虑 ， 我 们 在 原来 的 基础 上 增加 了 蓝牙 透 传 模块 ， 硬 件 焊 盘 上 兼容 蓝牙 2.1 和 蓝牙 4.0 BLE 技 
术 。 就 是 说 ， 同 样 一 个 Crazepony 的 很 PCB 板 ， 可 以 选择 焊接 蓝牙 2.1 和 蓝牙 BLE 的 模块 。 


蓝牙 协议 是 很 复杂 的 ， 要 想 去 接触 并 试图 一 步 一 步 的 写 出 来 ， 在 我 现 有 的 时 间 下 ， 几 乎 不 太 

可 能 了 。 而 将 蓝牙 透明 传输 成 串口 ， 这 就 很 好 的 将 Crazepony 与 安 卓 设备 对 接 了 ， 可 以 直接 在 
安 卓 设备 上 面 开 发 遥控 app 或 者 上 位 机 。 这 想 想 也 有 点 小 激动 呢 ， 于 是 ， 我 们 真 的 这 么 干 了 ， 

也 成 功 了 。 


Crazepony 的 主要 硬件 介绍 到 这 里 融 告 一段 洲 了 ， 笔 者 刚 结束 学 生 时 代 ， 工 程 经 验 十 分 有 限 ， 
硬件 设计 过 程 中 肯定 许多 有 不 足 和 漏洞 ， 希 望 广大 读者 指正 ， 我 们 一 定 会 积极 接受 意见 并 作 
出 修订 ， 希 望 把 Crazepony 做 得 更 加 完善 ， 更 加 稳定 ， 给 这 片 土地 上 的 广大 爱好 者 提供 丰富 的 
资料 和 开发 经 验 。 


软件 框架 讲解 


作者 : nieyong 


飞 控 源 代 码 部 分 ， 都 是 属于 一 砖 一 瓦 融 出 来 的 。 没 有 使 用 实时 操作 系统 \(RTOS) ， 我 们 称 之 
为 裸 机 代码 ， 托 管 在 Github 上 ， 名 字 为 crazepony-firmware-none， 尾 级 none 表 示 未 使 用 操作 
系统 梨 跑 的 意思 。 


那么 ， 现 在 器 结合 梨 机 代码 ， 来 说 说 Crazepony 的 软件 框架 。 


本 文档 以 Crazepony 5.2 版 本 为 基础 。Crazepony 5.0 版 本 及 以 前 的 代码 主要 由 马 骏 
(CamelGo) 完成 。 贡 献 者 黄 永 冬 在 5.1 版 本 中 对 飞 控 代 码 进 行 了 重 构 ， 将 Crazepony 的 
稳定 性 推 向 了 一 个 新 的 高 度 。 和 贡献 者 Nieyong 在 5.2 版 本 中 对 代码 进行 了 整理 。 


软件 流程 


Crazepony 软 件 流程 如 下 图 所 示 : 
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天 并 禹 控 误 据 接 牙 A A a 
= 说 明 ， 系统 采用 TIM4 定 时 
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\ 累加 ， 从 而 定时 普 个 时 间 
段 进行 传感器 数据 获取 、 


: 表 控 指令 、 电 机 控制 等 。 
控制 指 和 他 解 新 





控制 数据 计算 处 理 





Craepony 主 控 使 用 的 是 STM32 心 片 ， 没 有 上 实时 操作 系统 ， 依 靠 中 断 认 套 来 完成 整体 功能 。 
程序 核心 就 是 通过 定时 器 ， 在 主 循环 中 通过 不 断 查询 判断 各 个 条 件 ， 这 样 就 产生 了 几 个 大 小 
不 一 样 的 时 间 段 ， 我 们 根据 需 ay 遥控 器 指令 、 多 久 更 新 一 
次 传感器 数据 、 多 久 更 新 一 次 控制 等 等 飞 控 需 要 实现 的 功能 ， 尽 可 能 的 利用 主 控 的 资源 。 


倪 始 化 


进入 主 函 数 之 后 融 是 STM32 义 理 器 及 各 个 部 分 的 初始 化 。 
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E etRX Mode(); 无 线 樟 芷 为 接收 樟 式 
IREmatching IRF24L01 对 频 RE | 
< > 
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接 下 来 融 是 进入 主 循环 while(1) 之 中 了 ， 主 循环 也 束 是 整个 程序 功能 实现 的 关键 ,程序 进 入 
这 里 面 束 循环 在 里 面 运行 了 ， 当 然 中 断 会 打 断 去 运行 中 断 服 务 程序 运行 完 之 后 再 回 到 这 里 运 


主 循环 -100Hz 循 环 


主 循环 体 中 首先 有 if(loop10gHzcnt >= 10){} 这 个 结构 ， 其 中 loop100HzCnt 这 个 变量 是 在 
TIM4 中 断 服务 程序 中 累加 的 ，1ms 累 加 一 次 ， 也 融 是 说 定时 每 10ms 融 去 完成 一 次 其 中 的 工 
作 。 


那么 100Hz 需 要 做 一 次 的 工作 是 什么 呢 ? 读 取 mpu6050 数 据 ， 气 不 | J 整合。 因为 
采用 软 解 容 态 ， 读 取 的 数据 为 加 速度 计 和 陛 螺 仪 的 AD 值 ， 将 数据 进行 标定 、 滤 波 、 校 正 后 通 
过 四 元 素 融 合 得 到 三 轴 欧 拉 角 度 。 如 下 图 。 


| 来 翌 





一 i per ap AD 也 滤波 标 是 : . 由 带 隔 . RE :Ep 开本 a 和 
三 粕 陀螺 仅 遇 角 速度 绿 移 校正 四 元 素 融 会 [一 | 欧 拉 明 转 挤 
el Was rie 
当 样 。 
AD 件 滤波 标定 三 | 


二 轴 加 速度 误差 计 得 


轴 加 速 庶 





加 速度 传感器 采集 数据 容易 失真 ， 造 成 容 态 解 算 出 来 的 欧 拉 和 角 错 误 ， 只 用 角度 单 环 情况 下 ， 
使 系统 很 难 稳 定 运行 ， 因 此 可 以 加 入 角速度 作为 内 环 ， 角 速度 由 陀螺 仪 采集 数据 输出 ， 采 集 
值 一 般 不 存在 受 外 界 影 响 情况 ， 岳 干扰 能 力 强 ， 并 且 角 速度 变化 灵敏 ， 当 受 外 界 干扰 时 回复 
迅速 增强 了 系统 的 鲁 棒 性 。 


Crazepony 采 用 双 闭 环 PID 控 制 ， 如 下 图 所 示 。 


期 望 欧 拉 角 DE “~ 如 | 角速度 PID 


| 骨 隶 度 变 北 


陀螺 仪 采 样 


衣 速 度 


宁 际 欧 拉 角 





角度 作为 外 环 ， 角 速度 作为 内 环 ， 进 行 姿 态 双 环 PID 控 制 。 角 大 环 的 输出 值 作为 角速度 环 的 输 
人 建立 目 稳 系统 。 


主 循环 -50Hz 衢 环 


在 if(1oop59HzFlag){} 进入 50Hz (20ms 执 行 一 次 ) 循环 。 loop5gHzFlag 标记 位 是 在 TIM4 中 
断 中 每 20ms 置 位 一 次 的 ， 这 里 解析 了 收 到 的 遥控 器 无 线 发 送 过 来 的 指 仿 ， 结 合 当前 的 安 态 计 
算 更 新 这 些 控 数 据 给 核心 控制 算法 输出 控制 飞 控 ， 我 们 融 可 以 控制 飞 控 前 进 后 退 ， 上 升 下 降 
等 等 操作 了 。 如 下 图 。 


Crazepony 开 源 四 轴 飞 行 磊 
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i 门 臣 回 印 |% 与 区 各 中 | 人 从 人 人 黎 | 证 梓 族 | 团 HamEocm 国电 内 | 四 | @ 
: 尖 国 滑 营 汪 | 旋 | crazepony YY 人 是 己 多 的 
Project | 电 ioh | 因 ”stm32f1 四 = x 
#3 Crarepony /1 人 
4 全 | StartUp 166 execTime{[1]=micros()-startTime{[1]; 本 
+ Har dWarelriver 167 } 
+ 全 | User_Sre 168 //Need to recieve 2401 RC instantly so as to clear reg. 
4- 俩 | Lib 169 Nrf Irq(); 
-全 Control 170 //SOHz loop 
由 上 Control.e Eh if (loopSOHzF1lag) 
由 因 ReceiveData c 下 { 
173 loopSOHzF1lag=0; 
174 realExecPrd[3]=micros()-startTime{[3]; 
ey startTime[3]=micros(); 
176 
全 了 7 RCDataProcess(); 
178 
179 FlightModeFSMSimpile(); 
180 
18 // DetectLand{(); 
18 if(laltCtriMode==LANDING) 
183 口 { 
184 AutoLand () : 
18 } 
18 
187 ZAltitudeCombineThread(); 6 
88 > 
189 CErIATES()? 
190 三 
191 CtrlAttiAng(); 
192 3 
193 //PC Monitor 
194 if (btSrc!=SRC APP) 
195 CommPCUploadHandle(); //tobe improved inside 
196 
197 execTime[3]=micros()-startTime{[3]; 
198 } 
199 //10Hz loop es 
6... | {}F... |0.T | 有 E 了 国 
| J-LINK / J-TRACE Cortex L:210 C:W CaP NUM SCRL OVR RIW 


主 循环 -10Hz 循 环 


同样 的 思路 if(looploHzFlag){f} 也 就 是 以 10Hz 的 频率 去 执行 下 面 功 能 。 在 这 里 可 以 通过 蓝牙 
向 我 们 的 手机 APP 传 送 一 些 飞 控 的 姿态 信息 ， 然 后 查询 飞 控 的 电量 没有 足够 的 话 就 让 飞 控 降 
落下 来 ， 查 询 高 度 啊 超出 可 控 范 围 也 把 飞 控 降下 来 ， 查 询 是 否 和 遥控 器 失 联 啊 ， 失 联 就 降下 
飞 控 等 等 安全 飞行 的 控制 。 如 下 图 
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: 门 臣 回 息 |X 曲 区 二 闪 名 名 网 | 址 杜 诺 酥 | 欧 HIGH_FREQ_CTRL 号 民 内 本 ec 我 | 国 -| Dy 
: 富山 溺 芝 马 | 问 | crazepony Y 信 和 遇 己 坟 的 
Project cj CommpPc'c | = = :| SysConfia 区] stm32fl0x gpio.c | 团 startup_stm32fl0x_md.s f - i 3 Xx 
sd Crarepony | 198 } 人 
4 StartUp 199 //1i0Hz loop 
+ Har dWarelriver 200 if (loop1i0HzF1lag) 
+ User_Sre 201 口 { 
由 .全 Lib 202 loopi0HzFlag=0; 
口 - 仿 Control 203 realFExecPrd[2]=micros()-startTime [2]; 
由 . 轩 Control.e 204 startTime[2]=micros(); 
由 因 Receivelata. e 205 
206 //Check battery every BAT CHK PRD ms 
207 if((++batCnt) * 100 >=BAT CHK PRD) 
208 口 { 
209 batCnt=0; 
210 BatteryCheck(); 
了 } 
212 //App monitor 
2 if (fiyLogApp) 
214 口 { 
kh CommaAppUpload(); 
216 filyLogApp=0; 
Py } 
218 
219 //EEPROM Conifg Table request to write. 
220 if(lgParamsSaveEEPROMReaquset) | 
221 日 { 十 
222 GParamsSaveEEPROMRedquset=0; 
了 了 号 SaveParamsToEEPROM(); 
224 } 
Le 
226 FailSafeLostRC(); 
227 
228 FailSafeCrasn(); l 
229 
230 FailSafeLEDAlarm(); 村 
PE 
| 232 LEDFSM (); /7 闪烁 
国 P... | 令 6... | QF... 10 | | 因 I > 





| JLINK / J-TRACE Cortex 1:241C: 国 :和 Cp NUM =cRL oOVR RM 
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最 后 就 是 if(pcCmdFlag) 这 个 了 ， 这 是 一 个 与 上 位 机 调试 有 关 的 东西 ， 主 循环 查询 这 个 标志 


位 ， 标 志 位 是 由 上 位 机 发 送 过 来 的 指 倒置 位 的 ， 它 主要 是 处 理 pc 机 发 送 过 来 的 指 合 ，PID 参 数 


读 取 ， 修 改 等 等 。 


Crazepony 软 件 开 发 经 验 总 结 


天 于 Z 轴 负 友 馈 的 调试 


虽然 我 们 已 经 努力 将 机 身 参 效 设 计 成 没有 个 体 甜 异 ,但 是 还 是 避免 不 了 一 些 电阻 电容 上 有 误 
壬 。 瘟 接 体现 在 MPU6050 输 出 的 姿态 AD 值 上 有 个 体 魏 异 ， 下 面谈 一 谈 用 户 拿 到 飞机 以 后 ， 怎 
样 保证 飞机 起 飞 降落 过 程 具 有 丫 深 性 的 问题 

什么 叫 粘 清 性 ? 融 是 说 ， 飞 机 上 升 的 时 候 ， 不 会 因为 油门 突然 加 大 而 突然 抑 升 ， 也 不 会 因为 
油门 不 小 心 拉 低 过 快 导致 飞机 快速 跌落 到 地 面 ， 那 么 怎样 才能 达到 这 样 的 效果 呢 ? 
我 们 都 知道 ， 飞 机 在 空中 的 任何 一 个 动作 或 者 容 态 ， 都 会 役 安 态 传感器 采集 到 ， 那 么 飞机 上 
升 和 下 降 这 个 动作 ， 对 应 的 是 哪个 物理 量 在 变化 呢 ?Z 轴 的 速度 ?还 是 飞机 的 高 度 ? 这 两 者 都 
在 变化 ， 但 是 姿态 传感器 都 不 能 下 接 给 出 ， 然 而 ，Z 轴 的 加 速度 是 姿态 传感器 可 以 直接 给 出 的 
下 面 我 们 来 理 一 下 这 个 过 程 Z 轴 加 速度 是 怎么 变化 的 。 


中 学 毕业 的 人 都 知道 这 样 一 件 事情 就 是 关于 失重 和 超重 ， 飞 机 加 速 上 升 这 个 过 程 ，Z 轴 的 加 速 
及 会 大 于 静止 时 的 加 速度 9.8m/s2， 飞 机 加 速 下 降 这 个 过 程 ，Z 轴 加 速 会 小 于 9.8m/s2 ， 这 个 
物理 量 ， 可 以 由 传感器 直接 得 到 ， 而 这 个 物理 量 的 变化 ， 恰 恰 就 能 得 到 飞机 是 正在 上 升 还 是 
正在 下 降 ， 那 么 上 升 的 时 候 ， 程 序 控制 它 油 门 增加 量 不 要 变化 那么 快 ， 下 降 的 时 候 ， 程 序 控 
制 它 油门 减少 量 不 要 减 那 么 快 。So... 


学 过 大 学 相关 控制 理论 的 人 都 知道 ， 这 种 控制 方式 叫做 负 反 馈 。 
对 应 到 程序 就 是 这 样 的 : 


Project 有 因 mainc 因 Tmc” 因 Controlkc* ， 轩 REceiveDatac ，[ 贡 NRF24L01.c 
























































由 -. 国 IIC.c 81 EXP ANGLE.X = (float) (RC_ DATA.ROOL); 
由 - 国 Tim<c 82 EXP ANGLE.Y = (float) (RC_DRTR.PITCH) ; 
1 83 EXP ANGLE.Z = (float) (RC DATA.YANW); 
由 | 上旬 Moto.c 
一 84 
由 - 蜀 NRF24L01.c 85 DIF RANGLE .X = EXP ANGLE.X - Q ANGLE .Ro1l; 
: 由- 国 SPLc 86 DIF RANGLE .X = DIF RANGLE .X; 
由 - 轩 stmflash.c 87 
由- 国 UART1.c 88 DIF RANGLE.Y = EXP ANGLE.Y - Q ANGLE.Pitch; 
一 89 DIF ANGLE.Y = DIF ANGLE.Y; 
由 -| 区 Battery.c g0 
田 - 国 DMP.c 91 DIF ACC.Z = DMP DATA.dmp accz - g; //z 轴 加 速度 实际 与 静止 时 的 差 值 ，g 为 当地 重力 加 速度 ， 在 DMP.h 中 宏 定 义 
由 国 BT.c 92 Pa 
上 93 PID 核 心算 法 部 分 
+ Ba HMC5883L.c 了 一 庄 突 宙 宙 六 / 
‘Ey User Src 95 // 俯仰 角 
可- 困 main.c 96 Pitch = PID Motor.P * DIF ANGLE.Y; //DIF_ANGLE .Y 为 Y 轴 的 期 望 角度 和 当前 实际 角度 的 误差 角度 
由 - 国 sm32f10x itc 97 Pitch -= PID Motor.D * DMP DATA.GYROy;  //DMP DATA.GYROY 为 Y 轴 的 误差 角度 的 微分 ， 即 Y 轴 的 角速度 单位 。/ 
i 98 // 械 滚 角 
Sys_Fun. 
| 外国 Sysune g9 Rool = PID Motor.P* DIF ANGLE.X; //DIF_ANGLE .x 为 x 辖 的 期 望 角 度 和 当前 实际 角度 的 误差 角度 
全 Hb 100 Rool -= PID Motor.D * DMP DATA.GYROx;  ”//DMP_ DATA.GYROx 为 x 轴 的 误差 角度 的 微分 ， 即 x 轴 的 角速度 单位 。/ 
由 - 因 misc.c = 101 // 基 础 油门 动力 
由 - 国 stm32f10x_gpio.c 102 Thr = 0.001*RC DATA.THROTTLE*RC DATA.THROTTLE; 。”//RC_DaTRA.THROTTILE 为 0 到 1000, 将 摇 杆 油门 曲线 转换 为 下 目的 抛物 线 
人 103 Thr -=150*DIF ACC.2; // 对 z 辖 用 一 》 欠 负 反馈 控制 
由 上 stm32f10x_rcc.c 本 一 
了 这 104 /TXAM 
9 所 stm32f10x tim.c 105 DMP DATA.GYROZz+=EXP ANGLE.2/2; 
加 内 stm32f10x usart.c 106 Yaw=-20*DMP DATA.GYROz; 
由 -. 国 stm32f10x i2c.c 107 // 将 输出 值 融 合 到 四 个 电机 
i a 108 Motor[2] = (Int16 t) (Thr - Pitch -Rool- Yaw ); //M3 
+. f " 
本 的 109 Motor[0] = (int16 t) (Thr + Pitch +Rool- Yaw ); / /M1 
”四 * 周 stm32f10x_pwr.c 110 Motor[3] = (int16 t) (Thr - Pitch +Rool+ Yaw ); //M4 
"a Control 下 是 Motoz [1] = (int16 t) (Thr + Pitch -Rool+ Yaw ); //M2 
a [Convole | 112 
Ei [TN ocer malt 区 IE( (FLY ENABLE==0xA5))MotorPwmFlash (Motor[0],Motor[1],Motor[2],Motor[3]); 
由 "加 “ec 114 else MotorPpwmFlash (0,0,0,0); ;// 避 免 飞 机 落地 重启 时 突然 打转 EE 
4 0] ' 115 if (NRF24L01 RXDATA[10]==0xA5) MotorPwmFlash(5,5,Motor[2],Motor[3]); // 一 键 操作， 翻滚 返航 等 





A FE 


Thr 是 一 个 油门 的 全 局 变量 ， 在 Thr 被 听 控 数据 赋值 以 后 ， 再 对 Thr 进 行 一 次 减 操作 ， 减 去 一 个 
误差 量 DIF ACC.Z，DIF OO i 当 飞 机 上 升 
时 ，DIF_ACC.Z 是 一 个 正 数 ，Thr 减 去 一 个 正 数 ，Thr 融 会 比 遥 控 实 际 赋值 要 小 ， 体 现 出 来 的 
效果 就 是 上 升 不 会 那么 冲 ; 同 理 ， 下 降 时 DIF EN Thr 减 去 一 个 负数 ， 相 当 于 
加 上 一 个 正 效 ，Thr 融 比 遥 控 实 际 赋值 要 大 ， 体 现 出 的 效果 融 是 下 降 不 会 很 急 。 


于 是 ， 综 上 的 朱 述 ， 飞 机 的 飞行 体现 出 粘 淆 的 效果 ， 便 于 操 搜 ， 也 安全 了 许多 
所 以 ， 在 用 户 拿 到 手 后 ， 如 果 感 觉 操作 起 来 不 是 那么 方便 ， 可 以 打开 串口 助手 看 看 这 
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将 Crazepony 水 平静 止 放 置 ， 然 后 看 看 这 里 打印 的 Z 轴 加 速度 值 是 多 少 ， 将 源 代码 的 静止 重力 
加 速度 值 g， 修 改 成 串口 助手 里 看 到 的 那个 值 就 好 了 ， 这 是 属于 一 个 初始 人 工 校准 过 程 ， 我 们 
后 续 会 考虑 实现 一 个 学 习 算法 来 替代 这 个 过 程 ， 它 将 不 会 再 需要 用 户 介 入 ， 你 只 需要 开 一 
电源 开关 ， 学 习 算 法 会 自我 学 习 ， 将 学 习 得 到 的 最 优 参数 存放 在 内 部 的 EEPROM 中 。 


天 于 油门 曲线 





在 Crazepony 最 初 的 几 个 版 本 中 ， 我 并 没有 油门 曲线 这 个 概念 ， 遥 控 给 多 少 ， 融 直接 给 PWM 
输出 ， 根 本 不 做 任何 可 能 的 处理 。 在 后 来 的 飞行 体验 中 ， 慢 慢 发 现 。 油 门 授 杆 的 前 半 程 ， 很 
容易 突然 推 很 多 ， 导 致 飞机 一 下 冲 很 遍 。 于 是 ， 在 跟 大 家 《的 交流 中 发 现 ， 将 遥控 送 给 的 油门 
值 曲线 化 以 后 再 给 PWM 输出 ， 这 样 的 话 。 融 能 避免 这 个 问题 了 。 




























































Projedt a 固 maine | 轩 Timc 因 Controlkc* [车 ReceveDataxc  [#] NRF2401c [] DMPR 
由 . 国 IIC.c EXP RANGLE .X = (float) (RC_DRTR.ROOL) ; 
由 - 国 Timc 82 EXP ANGLE.Y = (float) (RC DATA.PITCH); 
= 83 EXP ANGLE.Z = (float) (RC DATA.YAW); 
| 去 | Moto.c 一 一 
上 84 
由 - 轩 NRF24L01.c 85 DIF ANGLE.X = EXP RNGLE.X - Q_RNGLE .Roll1; 
蛋 - 困 SPLc 86 DIF ANGLE.X = DIF RANGLE .X; 
由 | 若 stmflash.c 87 
二 88 DIF ANGLE.Y = EXP ANGLE.Y - Q ANGLE .Pitch; 
i | 89 DIF ANGLE.Y = DIF ANGLE.Y; 
由 …| 基 Battery.c og0 > 一 
由 . 困 DMP.c 91 DIF ACC.Z = DMP DATA.dmp accz - g; //z 轴 加 速度 实际 与 静止 时 的 差 值 ，g 为 当地 重力 加 速度 ， 在 DMP.h 中 宏 定 义 
由 几 BT.c 92 日 突 认 突 认 认 认 认 宙 ta te dt dc 详实 认 突 认 认 祈祷 
i is 法 诗 分 
‘3 User_src 95 // 人 以 仰角 
四- 国 main.c 96 Pitch = PID Motor.P * DIF ANGLE.Y; //DIF_ANGLE .Y 为 Y 输 的 期 望 角度 和 当前 实际 角度 的 误差 角度 
由 - 国 stm32f10x_jt.c 97 Pitch -= PID Motor.D 放 DMP DATA.GYROYy;  ”//DMP DATA.GYROY 为 Y 轴 的 误差 角度 的 微分 ， 即 Y 轴 的 角速度 单位 。/s 
i 98 // 横 滚 角 
击 Fun. PR CE a 
图 Sys- on 99 Rool = PID Motor.P* DIF ANGLE.X; //DIF_ANGLE .x 为 x 轴 的 期 望 角度 和 当前 实际 角度 的 误差 角度 
全 Ub 100 Rool -= PID Motor.D * DMP_DATA.GYROx;  //DMP_DATA.GYROx 为 x 轴 的 误差 角度 的 微分 ， 即 x 轴 的 角速度 单位 。/s 
| Misc.c = 101 [基础 油门 动力 
二. 轩 stm32f10x_gpio.c | 102 //RC_DaTRA.THROTTIE 为 0 到 1000, 将 拱 杆 油门 曲线 转换 为 下 四 的 抛物 线 
| stm32f10x_rcc.c 3 // 对 z 轴 用 一 次 负 反 馈 控制 
和 104 // YAW 
由 - 轩 stm32f10x tim'c 105 DMP DATA.GYROZz+=EXP RANGLE .2/2; 
由 上 罗 stm32f10x_usart.c 106 Yaw=—-20*DMP DATA.GYROz; 
由 -. 困 stm32f1i0x i2c.c 107 // 将 输出 值 融 合 到 四 个 电机 
上 二 . 108 Motor[2] = (int16 t) (Thr - Pitch -Rool- Yaw ); / /M3 
+ f 一 
Li re oa 109 Motor[0] = (int16 t) (Thr + Pitch +Rool- Yaw ); //M1 
相国 stm32f10x_pwr.c 110 Motor[3] = (int16 t) (Thr - Pitch +Rool+ Yaw ); / /M4 
SS Control 站 本 可 Motor[1] = (int16 t) (Thr + Pitch -Rool+ Yaw ); //M2 
由 …| 贡 Control.c 112 
.econ = 113 if( (FLY ENABLE==0xA5))MotorPwmFlash (Motor[0],Motor[1],Motor[2],Motor[3]); 
央 3 114 else MotorPwmFlash(0,0,0,0) /7 避免 飞机 落地 重启 时 突然 打转 
4 0 ' 115 if (NRF24L01 RXDATA[10]==0xA5) MotorPwmFlash(5,5,Motor[2],Motor[3]); // 一 键 操作 ， 翻 滚 返 航 等 
6o.. | {}Fu... |0um Ly ed py " 





很 显然 ， 我 料 油门 曲线 做 成 了 一 个 下 四 的 抛物 线 。 抛 物 线 方程 为 : y=0.001X2， 即 
Thr=0.001( RC _DATA.THROTTLE) 2，RC DATA.THROTTLE 的 取 值 范围 是 0-999，Thr 的 
取 值 沁 围 也 是 0-999， 这 样 一 来 ， 将 帝 控 的 油门 授 杆 取 值 沁 围 ， 跟 飞机 实际 得 到 的 油门 量 做 了 
一 个 一 一 映射 。 最 大 值 和 最 小 值 都 是 一 样 的 ， 但 是 处 理 后 的 油门 曲线 是 一 条 下 凹 的 曲线 ， 和 
原来 线性 对 应 相 比 ， 优 势 大 家 目 己 实际 体会 吧 


Crazepony 开 源 四 轴 飞 行 二 


开发 指南 


本 章 介 绍 如 何在 windows/linux 下 搭建 开发 环境 ， 如 何 编 译 源 代码 ， 如 何 下 载 到 主 控 上 进行 调 
试 等 二 次 开发 的 步 又。 对 于 想 对 Crazepony 进 行 二 次 开发 的 小 伙伴 ， 能 够 提供 非常 完 各 的 指 
导 。 
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Windows 下 开发 环境 搭建 - 保 机 版 本 


作者 : nieyong 


IDE 开 发 工具 Keil v5.10 下 载 地 址 : Crazepony 百 度 云 网 盘 Keil-uVision5-MDK5-12.zip (5.2 及 
以 后 版 本 ) 。 


IDE 开 发 工具 Keil v4.10 下 载 地 址 : Crazepony 百 度 云 网 瘟 Keil-uVision4-MDK4-12.zip。 
飞 控 源 代码 下 载 地 址 : Github 项 目 crazepony-firmware-none。 


CP2102 了 驱动 及 ISP 烧 录 工 具 下 载 地 址 : Crazepony 百 度 云 网 间 开 发 工具 


环境 配置 说 明 


梨 机 版 本 是 指 没有 使 用 RTOS 的 主 控 固件 版 本 ， 由 于 没有 使 用 RTOS， 程 序 代 码 显 得 更 加 简单 
了 明了， 开发 环境 配置 简单 ， 非 前 适合 切 学 者 使 用 。 


保 机 版 本 的 代码 使 用 Keil 进 行 开发 编译 ， 下 面 介 绍 编 译 环境 的 搭建 和 编译 过 程 。 在 crazepony 
5.1 版 本 及 以 前 ， 使 用 keil 4.10 进 行 开 发 。 但 是 由 于 其 不 支持 utf-8 编 码 ， 所 以 从 5.1 版 本 之 后 都 
会 使 用 keil 5.10 版 本 进行 开发 。 


Keil 4 的 安 委 和 破解 


由 于 主 控 使 用 的 是 ARM Cortex-M3 内 核 的 STM32， 所 以 必须 使 用 带 有 ARM 编 译 工具 链 的 Keil 
4。 网 络 上 很 多 只 有 几 十 焰 大 小 的 的 Keil 4 可 能 只 支持 C51 开 发 。Crazepony 百 度 云 网 瘟 提 供 带 
有 ARM 编 译 工 具 链 的 Keil 4 安 委 文件 下 载 ， 带 有 破解 注册 机 和 人 破解 说 明文 档 。 用 户 目 行 下 载 安 
装 ， 可 以 看 到 该 Keil 版 本 为 v4.10。 


Bbout WH Yision 


Hvision v4.10 
Copyright to 2010 民 EIL An ARMR) Gompany 


以 


Toolchain: RealView MDK-ARN Version: 4.12 
Toolchain Path: BINA0 

Lompiler 上 TITICCE.EXE V4.1.0.481 
Assembler: ArmMasm.Exe Vd.1.0.481 
LinkeriLocator: ArmLink.Exe CVd.1.0.481 
Librarian: ATMAT.EXEe V4.1.0.481 
Hex Gonverter: FromeElf.Exe Vd.1.0.481 
CPL DLL SARMEGhS. DLL Vd.12 
Dialog DLL: DARMSTh.DOLL V1.4r 
Target DLL: SeggerJLa2CM3.dll Vz.00 
Dialog DLL: TARBMSTH.DLL V1.dr 


This product is licsensed to: 


nieyong JUJUNMAD 
WV JUJUNMAD.ORG 
LIC=UJWS8T-RC4FS-S9AG4-F7SIL-20WGQF-ACNIF 


This product 5 protected bry copyright lavw and international resties: Unavuthormed 


reproduction or distribution of this program, or amy portion of it mary resullt in severe ci op |nf 
and oriminal penalties, opY INIo 


Kail Software, the Keil Software Logo, and HVision are registered trademarks of KE 
Elektronik GmbH | Keil Software Inc, 


werces Wh Prser 


Licensed under the Apache Software License, Version 2,0 (http leverer apache.ong) OF 
rtions of this software copyright (cy 1993, TB Corporation (hitp:l wrena ibnn. oon 


该 安 六 文件 在 Windows XP，32 位 系统 上 测试 通过 。 已 知 存在 的 问题 : 





。 不 支持 utf-8 编 码 。Uutf-8 编 码 的 中 文 在 Keil 4 下 面 会 显示 为 乱码 ， 所 以 这 部 分 固件 代码 没 
使 用 utf-8 编 码 。 没 有 找到 能 够 配置 支持 utf-8 的 地 方 ， 很 可 能 是 Keil 版 本 比较 老 ， 或 者 破解 
导致 无 法 支持 utf-8 编 码 。 


Keil 5 的 安 半 和 破解 (推荐 ) 


最 新 crazepony 版 本 都 使 用 keil 5.10 进 行 开发 调试 ， 并 且 文 件 使 用 utf-8 编 码 。crazepony 百 度 
云 盘 提供 keil 5.10 安 委 文 件 下 载 。 并 且 可 以 注册 破解 。 


Keil 5 的 安 委 文件 是 Keil 4 的 几 倍 ， 很 多 组 件 与 模板 都 需要 分 开 来 安 芭 ， 安 妆 稍 微 比较 麻烦 。 
在 安装 完 主 程序 之 后 ， 会 弹出 Pack Installer 的 对 话 框 ， 用 于 被 开发 芯片 对 应 模板 的 安装 。 
crazepony 使 用 的 STM32F103T8 主 控 忌 片 ， 所 以 从 右边 选择 STM32F1 Series， 在 左 侧 点 击 安 


半 
o 








Crazepony 开 源 四 











隔 1 
希 Pack Installer | 呈 | 回 | 学 
Fle Packs Window Help 


| 


局 | Device: STMicroelectronics - STM32F2 Series 
















































4| Packs | Examples pl i 

| 本 se 
由 …ARM::CMSIS 会 Uptodate| Cortex Microcontroller Software Interface Standard (CMSIS) CORE, DS | Device Summary 
(+)--Keil::MDK-Middleware 侈 Update | Kell MDK-ARM Professional Middleware for ARM Cortex-M based dev Analog Devices Ta 








Keilk::MDK-Network_DS > Install | Keil MDK-ARM Professional Middleware Dual-Stack IPv4/IPv6é Networl 


- 9 Atmel 147 Devices 
长 ell:STM32F2xx_DFP < STMicroelectronics STM32F2 Series Device Support, Drivers and Examf| | 由 -全 En ergy Micro 198 Devices 

















| TwIP::lwIP €> Install lwIP is a light-weight implementation of the TCP/IP protocol suite 
wolfSSL::CyaSSL > Install Light weight SSL/TLS and Crypt Library for Embedded Systems 


:| HY Freescale 209 Devices 














HY Infineon 81 Devices 














H 有 Maxim 4 Devices 





HY Nordic Semiconductor |6 Devices 
多 NXP 129 Devices 
YY SONiX 40 Devices 
]… 多 Spansion 255 Devices 
口 … 时 STMicroelectronics 395 Devices 
由 -名 STM32Fl Series |95 Devices 
由 - 训 STM32F2 Series |46 Devices 
出 和 STM32F3 Series 70 Devices 
由 .名 STM32F4 Series |110 Devices 
四: 铬 STM32L1 Series |69 Devices 
出 名 STM32W1 Series 5 Devices 
HY Texas Instruments 340 Devices 
HY Toshiba 63 Devices 










































































Action [1 left): Installing “Keil,STM32F1o_DFP.1,1,0", downloading http://Wwww, Keil,.com/pack/Keil,.STM32F1yx_DFP.1,1,0,pack 
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ES 


瘟 代 码 下 载 
主 控 固 件 梨 机 版 本 ， 裸 机 指 没 有 使 用 实时 操作 系统 RTOS。 由 于 没有 使 用 RTOS， 所 以 代码 更 
加 简单 明了 ， 适 合 初学 者 使 用 。 


Crazepony 项 目 是 开源 的 ， 所 有 代码 都 托管 在 Github 的 Crazepony 项 目下 。 裸 机 源 代 码 放 和 置 
在 crazepony-firmware-none 下 ， 命 名 中 的 none 表 示 不 使 用 RTOS。 


可 以 直接 使 用 git 获 得 源 代码 ， 也 可 以 从 crazepony-firmware-none release 下 载 各 个 版 本 的 裸 
机 源 代 码 。 


V2.3.1 
| nieyong released this yesterday at 下 午 3:49 .0 commits to master since this release 
姿态 解 算 使 用 四 元 过 DMP 硬 解 


s。 添加 四 元 素 DMP 硬 解 功能 
s 修改 稳定 性 算法 


El Source code (zip) ESource code (tar.gz) 


ee 点 击 下 载 源 代码 
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源 代 码 导 人 和 编译 
在 源 代 码 中 ， 有 三 个 文件 为 Keil 工 程 文件 。 


Crazepony .uvopt 
Crazepony .uvpro] 
Crazepony.dep 


以 Keil 5 为 例 ， 点 击 Project 栏 目下 Open project， 打 开 代 码 解 压 所 在 文件 夹 选中 
Crazepony.uvproj， 此 时 已 料 代 码 项 目 工 程 所 有 文件 导入 Keil 5， 如 图 所 示 : 


[IN AHRS 一 hn Fisiord 
Be Edt Wew Boect Fas Debog 
:加 占 国 训 了 区 
| ys 
nraject 于 | 站 
三 镶 mas 编译 整个 工程 | 

忆 -startUg 

入 二 Hariarelrirer 


十 轩 mLse. C 

: | RIE spa 二 
stnd2ElDs Fee, 
shrietflOr _tin. 
stn3atlOk meurt. ce 


shmwi2EiNse isn. a 


Em dE IDs ap 省- 


医 区 区 本 加 
中 了 


请 吊 师 = 
1 r 加 


sknieFlDx pwr, < 
Control 

] -| 区 Contral.e 

| 划 IRU a 


中 
让 
号 
| 
E 
i Can 
中 


汗 当 竹 主 


| 下 
Fr 下 
Tar ra 


芝 芭 区 


瑟 - 撕 


ud 中 um 
SOmmiling StiT1DR spi,. CG... 
了 了 - 莒 CEI2T1OR FYE 下 [如 i 
译 刻 功 ， 生 成 加 oaft.ax 人 等 可 烧 写 固 | 
ode 一 和 1 站 生怕 一 中 et 各 和 一 at 和 呈 一 串 Em 二 秽 译 成 功 ， 生 成 Areaft,axf 等 可 党 写 固 件 
二 区 时 生硬 要 在 二 和 计生 瑟 二 贡生 。 = 


UEPUL AirTeratc,. xft™ = 0 rEOrFLB)r 











Cor 旬 # 本 要 JLINKII Trace 





点 击 左 上 角 的 编译 按钮 ， 编 译 整个 项 目 ， 在 工程 下 生成 Output 目 录 ， 目 录 中 Crazepony.hex 就 
是 可 以 烧 写 到 STM32 的 固件 。 


STM32 固 件 的 调试 和 烧 和 人 可 以 使 用 J-Link 或 者 ST-Link 等 调试 器 进行 开发 ， 详 见 J-Link 的 使 用 
及 弟 见 问题 。Crazepony 也 支持 USB 口 烧 入 ， 即 采用 ISP 下 载 ， 操 作 和 简单。 只 需要 安装 cp2102 
驱动 程序 ， 使 用 一 根 Mini USB 数 据 线 连接 电脑 。 详 见 固 件 烧 写 ， 烧 录 界 面 如 图 所 示 : 


起 mcuisp V0.993-- 单 片 机 在 些 绽 程 专家 --www.mecuisp.com 


圣 统 [人 帮助 四 ”Language 搜索 齐 口 汐 间 portCOM3 bps:115200 


www.mcuisp,com 免费 软件 脱 机 ,高洁 编 得 器 (WY) 
联机 下 载 时 有 的 程序 况 忻 : 


FEF Withubycrazepony-frmware-noneWOutputCrazepony， hex 


J 


一 

园 占 程 后 In 和 

| | 司 用 RamIsp 
四] 连 娃 烧 录 模式 


二 本 有 .2， 接 收 到 :79 
| 在 圳 口 CoM3 连 接 成 功 了 115200bps， 在 时 250 芋 种 
sse | 芒 片 内 BootLoader 版 本 号 -2.2 
寺 黄 子 记 区 : 


芒 片 PID: 00000410 
趾 | 编 程 到 FLASH 时 写 选 项 入 片 FLASH 容 量 为 643 


读 悍 护 ， 3a5 ”硬件 选项 ， - 思 蕊 片 SRAM 容 量 为 65535KB (此 信息 色 供 参考 ,新 版 本 


瑟 悍 护 : FF FF FF FF 用 户 数 据 0-1 FF 


会 片 拓 除 己 准 备 好 
已 写 六 19EB, 进 育 358， 砂 时 6755 苹 种 


RTS 扒 局 电 平 县 位 ,DTR 高 电 平 进 BootLoader 
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环境 配置 说 明 


目前 采用 Keil+gcc+jlink 是 最 好 的 编译 与 调试 方法 。Keil 内 部 有 目 己 的 编译 工具 链 ， 但 是 Keil 目 
带 的 编译 器 不 文 持 目前 代码 的 许多 语法 ， 所 以 建议 使 用 gcc 工 具 链 。 等 代码 稳定 未 来 可 以 直接 
移植 到 Keil 自 带 的 编译 器 上 。 


安装 arm-none-eabi gcc 工 具 链 


arm-2013.11-24-arm-none-eabi 的 下 载 地 址 


。 为 了 后 面 配置 的 方便 ， 在 其 中 的 "Next" 菜 单 中 选择 "添加 参数 到 环境 变量 ”( 菜 单 提示 的 是 
大 文 ) 

。 路 径 请 注意 中 间 不 要 有 空格 。 比 如 我 的 根 路 径 是 : 
D:\MentorGraphics\Sourcery CodeBench Lite for ARM EABI 


使 用 Keil4 


右 Keil4 能 配置 成 功 ， 选 择 Keil4 将 是 最 方便 的 办 法 。 安 委 Keil4 并 配置 gcc 的 方法 : 


。 打开 工程 

e。 点 击 菜单 Project->Manage->Component,Envrenment,Book。 选 择 Folders/Entensions,， 
选择 勾 中 gcc 

。 把 路 径 设 置 为 工具 链 的 根 目 录 ， 比 如 我 的 环境 设置 为 : 
D:\MentorGraphics\Sourcery CodeBench Lite for ARM EABI 

e。 如 图 所 示 : 


anagre Project Ites | 
Froject Items Fol ders/ Extensions | Books | 


Dewelopment Tool Folders: Default File Evtensions: 


[se Settings fronm THDLS.INI: Fe > 

Tool Base Folder DeiLv5wp 到 i 二 

BIN: |H mew 史明 全 ”的 a 上 sm SoDurce: Fe en | 

INL. | | Ublect: EE 

LIB: | Library: EE 
Regfle: ET Docurment: [tnt: * ph: “inc 


Select SPh Dewvelopment Tools: 
[UsecaRM Compiler ARMCC Folder: | 之 让 ML 











[Use 0 am-none-eabi 动人 


GNU-Tool Folder ID:*hientorGraphicss Sourcers CodeBench Lite for SR ESBN, 5 








DF | Es | Help | 


使 用 Keil5 


各 Keil4 通 过 以 上 配置 ， 编 译 工程 的 时 候 提 示 找 不 到 gcc 或 认 不 出 来 编译 文件 的 名 字 ， 那 么 请 安 
半 Keil5。Keil5 的 安 半 文件 是 Keil4 的 几 倍 ， 很 多 组 件 与 模板 都 需要 分 开 来 安 蔷 ， 安 半 稍 微 比较 
厅 烦 。 


e 下 载 并 安装 : mdk510.exe 

。 下 载 并 安装 : mdkcm510.exe 

e 下 载 并 安装 : Keil.ARMCortex D...0.0.1.pack Cortex 相 关 模 板 文件 

。 下 载 并 安装 : Keil.STM32F1xx_D...1.0.4.pack STM32F1xx 相 关 模 板 

。 下 载 破 解 程序 打开 keil5-->FILE-->Lisence Managerment 用 破解 程序 生成 序列 号 并 输入 
到 Keil5 里 。 破 解 成 功 。 

e。 下 载 : http:Wurlcn/O3oSQL 解压 并 替换 keil15 根 目录 开始 的 C\Keil_v5\ARM\Segger 压 缩 
包 里 的 两 个 文件 ， 以 进行 jlink 调 试 : 

。 配置 gcc 如 同 Keil 的 方法 。 

。 注意 jlink 的 驱动 : win7 x64 与 win7/winxp x86 可 能 不 一 样 (TODO 提 供 链接 下 载 ) 


使 用 原生 态 的 make 编 译 


使 用 原生 态 的 make 编 译 也 很 方便 ， 并 且 也 可 以 通过 keil 来 下 载 并 调试 


安装 arm-none-eabi 工 具 链 修改 工具 链 根 目录 下 的 cs-make.exe 为 make.exe，cs-rm.exe 
为 rm.exe 

安装 python2.7 并 把 其 加 入 到 环境 变量 

下 载 MyGit， 并 得 到 Git 的 windows 版 工具 

下 载 crazyflie 的 默认 python-client 人 代码， 和 与 此 版 本 代码 在 同一 级 目录 

打开 MyGit，cd 到 项 目 代 码 目录 并 : make 


STM32 开 发 环境 搭建 -linux 


作者 : nieyong 


Crazepony 飞 控 主 板 使 用 STM32 作 为 主 控制 上 器， 下面 主要 介绍 如 何在 ubuntu 系 统 下 进行 
STM32 固 件 的 开发 /编译 /下 载 。 


对 STM32 开 发 需要 在 ubuntu 系统 下 挫 建 arm 租 人 陈 开 发 的 交叉 编译 工具 链 。 测 试 的 系统 为 
ubuntu 14.04。 


交叉 编译 工具 妆 方 法 一 


STM32 人 处 理 器 使 用 gcc-arm-none-eabi- 交 叉 编译 链 。 使 用 wget 下 载 交 叉 编译 工具 链 到 本 地 ， 
并 且 解 压缩 到 ~/bin/ 目录 下 。 


wget https://launchpad.net/gcc-arm-embedded/4.7/4.7-2013-qi-update/+download/gcc-arm-none 
mkdir ~/bin 
癌 


修改 ~/.bashrc 文 件 ， 将 交叉 编译 工具 链 的 路 径 添 加 到 当前 用 户 的 默认 搜索 路 径 下 。 并 且 使 用 
source 人 命令 使 其 马上 生效 。 





echo -e "AnPATH=A\$PATH :$HOMEZblIn/Xgcc-arm-none-eab1-4 _ 7-2013q1/bin" >> ~/.bashrc 
source ~/ .bashrc 


可 以 使 用 type 命 命 令 测 交叉 编译 工具 是 否 安 疙 成 功 。 例如 检测 其 arm-none-eabi-gcc 命 仿 ， 可 
以 看 到 其 在 刚才 安装 的 ~/bin 目 录 下 检测 到 。 


type arm-none-eabi-gcc 
arm-none-eabi-gcc 是 /home/ny/bin/gcc-arm-none-eabi-4 7-2013q1/bin/arm-none-eabi-gcc 


交叉 编译 工具 小 方法 二 


方法 一 需要 手动 下 载 gcc-arm-none-eabi- 工 具 链 压缩 包 ， 解 压缩 ， 然 后 手动 配置 工具 链 的 地 址 
系统 默认 路 径 下 。 该 方法 适 ps 例如 fedora/ubuntu/debian 等 。 对 于 


ubuntu 用 户 ， 可 以 直接 使 用 人 进行 安装 。 


。 由 于 gcc-arm-none-eabi- 没 有 包含 在 ubuntu 默认 支持 的 包 内 ， 需 要 添加 一 个 支持 gcc-arm- 
none-eabi- 的 源 : 


sudo add-apt-repository ppa:terry.guo/gcc-arm-embedded 


。 更 新 添加 的 源 : 


sudo apt-get Update 


。 安装 gcc-arm-none-eabi- 工 具 链 
sudo apt-get install gcc-arm-none-eabi 


使 用 type 人 命令 检查 是 否 安 委 成 功 ， 如 果 出 现下 面 的 提示 ， 那 么 融 说 明 安 疼 成 功 ， 可 以 使 用 。 


$ type arm-none-eabi-gcc 
arm-none-eabi-gcc 是 /usr/bin/arm-none-eabi-gcc 


arm-none-eabi 说 明 


arm 相 关 的 交叉 编译 工具 链 由 很 多 ， 例 如 arm-linux-eabi，arm-none-eabi。STM32 钦 理 器 使 用 
的 是 arm-none-eabi。 


arm-none-eabi 和 arm-linux-eabi 等 的 区 别 : 

arm-1Linux-eabi 用 于 编译 arm 1inux 内 核 代码 。 

arm-none-eabi 不 指名 操作 系统 ， 可 以 是 linux， 也 可 以 是 vxworks 等 ，arm-none-eabi 不 包含 ”1inux  _ 等 人 
arm-none-linux-eabi 用 于 Linux 的 ， 使 用 Glibc。 





便 件 开发 工具 


Crazyflie 电 路 原理 图 使 用 的 KiCad，KiCad 以 一 个 开源 的 EDA 工 具 ， 并 且 跨 平台 ， 在 windows 
和 |linux 下 都 能 够 使 用 。 


KiCad 的 home page : http:Wwww.kicad-pcb.org/。 在 ubuntu 下 的 安装 : 


sudo apt-get install kicad 


Crazepony Android APP 开 发 和 配置 


作者 : nieyong 
Crazepony 的 Android 客 户 端 源 代码 也 是 托管 在 github 的 crazepony 项 上 目下， 点 击 这 里 查看 。 可 
以 直接 下 载 zip 压 缩 包 ， 也 可 以 通过 git clone 到 本 地 。 


git clone git@github.com:Crazepony/crazepony-android-client-none.git 


Crazepony Android APP 在 5.0 版 本 使 用 ADT Bundle 进 行 开发 。5.1 版 本 以 及 以 后 版 本 使 
用 Android Studio 进 行 开发 。 


ADT Bundle 开 发 环境 搭建 


Crazepony 5.0 版 本 的 Android APPP 开 发 环境 使 用 Google Android 提 供 的 一 站 式 开发 包 ADT 
Bundle。ADT Bundle 提 供 了 Android APP 开 发 所 需 的 所 有 工具 ， 包 括 Eclipse IDE，ADT 
(Android Developer Tools) 插件 ，java 库 等 等 。 


下 载 地 址 : http:/developerandroid.com/sdkindex.html。 该 下 载 地 址 现在 已 经 不 再 提供 
ADT Bundle 下 载 。 


下 载 解 压缩 到 任意 目录 ， 融 可 以 使 用 ， 无 需 安 到 。 


Android Studio 开 发 环境 搭建 


Google 已 经 提供 Android 集 成 开发 环境 Android Studio， 不 再 推荐 使 用 原来 集成 Eclipse IDE， 
ADT，Java 库 等 ADT Bundle。 所 以 Crazepony 5.1 版 本 以 及 以 后 版 本 使 用 Android Studio 进 行 
开发 。 

Android Studio 官 网 下 载 地 址 : http://developer.android.com/sdk/index.html。 
在 中 国 国内 提供 百度 云 胡 下 载 。 

百度 云 瘟 下 载 地 址 : 点 击 下 载 ， 提供 了 Android Studio 及 对 应 的 JDK 下 载 。 


首先 安装 下 载 的 jdk-7u67-windows-i586.exe， 然 后 再 安装 Android Studio 开 发 环境 。 


外 二 说 昌 


Crazepony 的 Android 客 户 端 默 认 编译 的 Android SDK API 版 本 为 15 (对 应 Android 4.0.3) ， 
支持 的 Android 版 本 为 4.0.0 或 以 上 。 


Android SDK Manager 





sDK Path: 
Packages 
天 Name API Rev. Status 
国 ARM EABIV7a System Image .18 ”2 朗 Installed 


区 Android 4.0.3 (API15) . . . 

别 ' SDK PlatForm . ' . : [4 Installed 

起 Samples for SDK ] ] 2 区 Installed 

国 ARM EABI via System Image . . 区 Installed 

愉 ! Google APls ] 1: ] 2 区 Installed 

上 站 Sources for Android SDK 车 Installed 
”Ea Android 4.01(API1 








Show: 站 Updates/New 图 Installed [| Obsolete select NeworUpdates Installpack: 


sort by: @ APl level () Repository Deselect All Delete Dack 
| -了 
Done loading packages. 0 + 


Properties for CrazyflieControl 





《可 Java Build Path < 二 
b Resource 
Android 





Android Lint Prefer' Build class path order and exported entries: 
A (Exported entries are contributed to dependent projects) 
口 日 这 


Java Build Path 
pp 加 瑟 Android Private Libraries 
加 吉 Android Dependencies um 
国 鱼 CrazyflieControl/src 
国 本 CrazyflieControlygen 










ee JavaCode style 

bp JavaCompiler 

bp Java Editor 
Javadoc Location 
Project References EE 
Refactoring History ~— 


上 


| Cancel 





USB 固 件 烧 瑟 


作者 : nieyong 
编译 好 STM32 的 代码 ， 得 到 hex 格 式 的 固件 文件 ， 如 何 烧 写 到 主 控 中 ? 
Crazepony 将 SWD 调 试 接口 预 留 出 来 ， 可 以 使 用 J-Link 或 者 ST-Link 竺 调试 器 进行 开发 ， 详 见 
J-Link 的 使 用 及 常见 问题 。Crazepony 也 支持 USB 口 烧 入 ， 即 采用 ISP 下 载 ， 操 作 简单 。 只 需 
要 安 帮 cp2102 驱 动 程序 ， 使 用 一 根 Mini USB 数 据 线 连 接 电 脑 。 这 里 就 详细 介绍 使 用 USB 固 件 
烧 宇 流程 。 


首先 从 crazepony 的 百度 云 瘟 中 下 载 开 发 工具 ， 点 击 这 里 。 解 奈奈 缩 文件 得 到 3 个 文件 夹 。 


安装 cp2102 了 驱动 


cp2102 是 Crazepony 上 使 用 的 USB 转 串口 心 片 。cp2102 和 STM32 心 片 以 串口 相连 ， 和 电脑 
PC 以 USB 接 口 相连 ， 这 是 Crazepony 能 够 接 上 USB 线 对 飞 控 / 遥 控 器 进行 固件 烧 写 编程 和 调试 
计 息 打印 的 原因 。 


站 先 要 把 cp2102 的 驱动 在 电脑 PC 上 装 好 ， 这 样 电脑 作为 Host 才 能 够 识别 到 cp2102。 这 个 驱 
动 在 32 位 windows xp 系统 /64 位 windows 7 系统 下 都 测试 通过 。 





CC 号 


全 气 
1) Installation completed successtullw 


锁定 





安装 成 功 之 后 ， 在 我 的 电脑 -> 设备 管理 -> 靖 口 (COM 和 LPT) ， 就 可 以 看 到 Crazepony 对 应 的 
串口 号 ， 例 如 下 图 为 COM3。 看 到 该 串口 中 有 关于 CP210x 的 摘 述 。 








Crazepony 开 源 四 轴 飞 行 丰 


-主唱 Ey EE i 
明 设备 管理 号 
文件 (前 ”操作 (A) ”查看 (V) 帮助 (H) 


包 中 | 而 | 轩 | 卓 | 呈 | 除 号 本 


通 卉 sDWhN-20140609WR 
;加 DVD/CD-ROM 驱动 器 
PE IDE ATA/ATAPI 控制 器 
;一 | 便 扒 设备 
;屋外 二 
b -Ga 磁盘 驱动 器 
> 声 电池 

4 .是 端口 (COM 和 LPT) 

二 巴 Silicon Labs CP210x USB to UART Bridge (COM3) 

> -加 计算 机 

; 蝎 人 体 学 输入 设备 

.是 声音 、 视 堪 和 游戏 控制 器 

-加 筷 标 和 其他 指针 设备 Crazepony 对 应 的 串口 ，CP210x 蕊 片 实现 USB 转 串口 

b - 晶 通 用 启 行 总 线 皖 制 器 

》- 夺 网 络 适配器 

”| 系统 设备 





烧 入 hex 文 件 


打开 ISP 下 载 右 ， 载 人 需要 下 载 的 hex 文 件 ， 具 体 如 下 图 所 示 。 


主 控 固 件 烧 罕 140 













堂 mcuisp VOD. 993-- 单 片 宙 在 线 编程 专家 --wwwmct 





系统 们 ) 帮助 四 1an Pr -一 一 一 Port bps:460800 WwWww:mculspcom 免费 软件 脏 村 /高 法 编 村 ee 
联机 下 载 时 的 程序 交 件 : 


reraftWProogramCrazEPony- 


手持 万 用 编程 如 





a er5.DWAircraftVOutputyCrazepony,hex FE 汕 往 前 重 装 交 忻 


PP | LPGaXXXISP 
os 





| 回 编程 到 FLASH 时 写 选 项 字 节 
区 ws 
写 保 护 :， FF FFE FF FF 用 户 数据 -1 FF EF 军 见 天 


| re 








































川 CTR 的 高 电 平 让 位 ,RTS 分 电 平 直 BootLoader 风 

DTR 的 豆 电 平 县 位 ,RTS 局 电 平 坦 BootLoader 

RTS 的 个 电 平 性-3W) 县 位 , 赴 用 DTR 一 上] 

RTS 的 民 电 下 复位 ,DTR 作 电 平 了 Boottoade | : 一 3 
| 








Ts 的 已 电 平 县 位 ,DTR 高 电 平 进 BootLoader 
TE 时 9) 县 位 :不 用 DTR 
FF HBootLoader 

Boot oade 


















在 硬件 设计 上 ， 下 搂 使 用 CP2102 复 位 STM32 并 且 引 导 进 人 串口 升级 固件 的 ISP 下 载 模式 。 

















CP2102 使 用 RTS 高 电 平复 位 STM32 心 片 ， 然 后 使 用 DTR 将 STM32 的 Boot0 引 脚 拉 低 ，STM32 


进入 串口 升级 固件 的 ISP 下 载 模式 。 所 以 在 ISP 下 载 器 上 ， 必 须 选 择 左 下 角 的 “RTS 的 高 电 平复 
位 ，DTR 高 电 平 进 Bootloader”。 


查看 打印 信息 


连 上 USB 线 ， 打 开 串 口 助手 ， 波 特 率 设 置 为 115200， 查 看 串口 打印 信息 。 默 认 每 隔 1 秒 打 印 一 


Crazepony 开 音 四 轴 飞 行 

















村 
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Crazepony 默 认 出 厂 固件 串口 打印 信息 和 上 位 机 数据 都 关闭 。USB 串 口 打印 和 USB 上 位 
机 同时 只 能 够 使 用 一 个 ， 不 能 够 同时 使 用 。 原 因 是 串口 上 的 上 位 机 数据 在 串口 助手 上 看 
到 的 是 乱码 。 要 使 用 串口 打印 信息 ， 请 开 和 启 sysconfig.h 中 的 DEBUG_UART 安 。 要 使 用 上 
位 机 查看 信息 ， 请 关闭 Sysconfig.h 中 的 DEBUG_UART 宏 ， 并 开启 main.c 中 

的 CommPCUploadHandle() 函数 。 








鼎 EscoM 3.3 Ee | © le 

中 中 让 让 让 中 中 中 让 中 让 中 让 让 中 让 中 中 中 中 让 让 中 让 中 中 中 中 中 中 中 中 让 中 让 中 让 中 中 中 中 让 让 中 让 中 中 让 让 中 让 中 字 中 中 中 让 中 让 让 字 中 中 中 中 四 
下 2 一 

六 Po | me] 

水 pe i 二 

x Re + 

he a mod a scat ee 水 

EY * 

i eA . 

下 下 

本 pi 本 

可 上 * 

中 中 让 让 让 中 中 中 让 中 让 让 让 让 中 中 中 中 中 让 让 让 让 让 中 中 让 中 中 让 中 中 让 中 让 中 中 中 中 中 中 让 让 让 让 中 中 让 让 中 让 中 中 让 让 让 让 中 中 中 中 中 中 中 中 


Crazeporm 一 II 报告 : 对 后 正和 福 运 行 


一 ?机 身 下 时 次 访 广 播 信 息 信 一 


前 ---> -84. 3535B1° 
前 ---> -8. 587731° 
:党 疙 一-》0.03747B* 


? 秆 基 记 生 度 -> -31. 200001° 
由 站 前 度 ---> -12 000000* 


Y 轴 误差 前 度 ---> -3. 4322869*° 
《各 计 要 且 展 - -31. 242BT8° 


谴 度 --->1. 322831mys2 
诬 --->》D 001132mys2 
麻 ---> 有 619627mis2 


X 轴 角 证 度 --->0.000000 ?js 
Y 帮 角 娃 度 ---> 0 D000000 。 js 
z 抽 角 奸 度 ---》-0. 060978 “7s 


间 1 FWMI 目 一 317 
M2 PWM 有 -422 
3 FWMI 目 一 432 
出 生 FWMI 且 一 一 一 当 站 4 


开机 碌 数 ---> B0051 


打开 六 件 | [文件 名 交 件 | 迟 止 发 送 | 扩 展 IFR RTS 
OS [Come =| 雷 打开 串口 | 帮助 | 一 一 清除 窗口 | 厂 1 显示 三 DT 


波 特 率 | 上 mx 次 三 二 和 大 是 电子 网 


四 图 





YW 亚 ; 雪 大 





WWWw.daxla, 本 R: 45850 |cDMaz 马 关 财 115200bps ETS= 0 DSR=0 RL ,dl 


—— 
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J-Link 的 使 用 及 常见 问题 


作者 : nieyong 


crazepony 除 了 可 以 使 用 usb 接 口 下载 程 序 之 外 ， 还 将 swd 接 口 预 留 到 了 板 外 。 可 以 使 用 J- 
Link，ST-Link 等 工具 进行 代码 的 烧 写 /在 线 调 试 等 。 下 面 介绍 J-Link 的 配置 和 常见 问题 。 


J-Link 与 Crazepony 的 接线 


一 般 我 们 买 到 的 J-Link 如 下 所 示 ， 是 一 个 20 针 的 排 线 口 。 对 于 SWD 接 口 ， 我 们 只 需要 使 用 3 根 
线束 可 以 。J-Link 和 Crazepony 的 连接 如 图 如 下 ， 使 用 彩虹 排 线 连接 就 可 以 。 (Crazepony 的 
SWD 接 口 排 阵 默 认 未 焊接 ) 


。 1 所 指 排 针 与 飞 控 的 VCC 相 连 (如 果 飞 机 自己 供电 ， 可 以 不 连接 ) 
。 2 所 指 排 阵 与 飞 控 的 GND 相 连 

。 3 所 指 排 阵 并 飞 控 的 DIO 相 连 

4 所 指 排 阵 并 与 飞 控 的 CLK 相 连 





J-Link 与 Crazepony 相 连 示 意图 。Crazepony 遥 控 器 的 连接 也 是 同 理 。 
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J-Link 的 配置 和 使 用 


使 用 keil 打 开 crazepony 工 程 文件 ， 点 击 Options for Target 'Crazepony'， 选 择 Debug 部 分 ， 下 
拉 选 择 J-Link/J-Trace Cortex. 


| 4 Options tor Target "Crazepony, EF | 
Device | Target | Dutput | Listine | User | CC 二 十 | hsm | Linker Tebue | ilities | 


Use Simulator Settings | te Lse: [LINK / J-TRACE Cortex =|| setings | 


[Limit Speed to Real-Time 


Iw Load Application at Startup [I Run to main() Iw Load Application at Startup Iw Run to main() 
Initialization File: Initialization File: 


| 


hestore Debug Session Settings Restore Debug Session Settings 
[wi Breakpoints I Toolbox [wi Breakpoints [wi Toolbox 
Iw Watch Windows & Perfomance Analyzer Iw Watch Windows 
Iw Memory Display [wi System Viewer [wi Memory Display [wi System Viewer 


CPLU DLL: Parameter: Driwer DLL: Parameter: 


[SARMCM3.DLL | [SARMCM3.DLL 


Dialog DLL: Parameter: Dialog DLL: Parameter: 


[bar MS TM.DOLL [psTM32F1 0318 [TAR MS TM.OLL [psTM32F1 0318 
OK | Carncel | Defaults | Helrp | 





4 二 口 口 


Crazepony 开 音 四 轴 飞 行 坪 











Cortex JLink/Trace Target Driver Setup | 


Debue | Trace | Flash Download | 


J-Link ”本 Trace hdapter Sh Tewice 


SH: |20080643 "| ILCODE Te Mowe 
Devwiee:| 天 Link AR SAD 全 OlBAD... ABEN Corasight SH-DP Up | 
mm: [vo a voe : Down | 


FW : 加 hEN VB 站 link 至 SW EE 
他 tl Ink 扫 括 下 忆 D 
Er "| Narmal Configurati Dewice Hame: 
huto ee hdd | Delete Update | IF len.: EE 


Cormect 血 Reset DEtlors Cache Options Dowrdoad Options 


-oTInect.: Hormal "| YeSet : Hormal "| [I¥ Cache Code [Verify Code Downlo 


IY Reset after Conn [wi Cache Memorw [Download to Flaskh 


Interface TCF/IF Mise 


Hetwork Settines 
ts USE CY TCP/IF Th hutodetec JLink Infd| 


Scan De 


State: ready 


应 用 局 ) 


在 选择 了 SW 接口 之 后 ， 将 飞 控 开 天 打 到 on， 和 点 击 Auto Alk， 如 果 连 接 正 确 ， 融 会 扫 拍 到 开发 


板 上 的 SW 接口 。 


J-Link 固 件 烧 写 





在 插 拔 的 过 程 中 ，J-Link 经 常会 出 现 固件 丢失 无 法 使 用 的 情况 ， 这 时 需要 重 刷 J-Link 调 试 器 的 


固件 。 或 者 从 keil el 5 的 时 候 ， leno ed 
下 面 以 J-Link V8 型 号 调试 其 为 例 说 明 如 何 重 刷 J-Link 的 固件 。 


安 丢 AT91-ISP， 安 玫 完 成 后 在 泉 面 上 将 有 两 图标。 





擦 除 心 片 ， 进 入 编程 模式 。J-Link 面 板 上 有 两 对 接口 ， 其 中 和 A 为 擦 除 ，B 为 编程 接口 。 
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一 二 于 
一 = 二 
BE =- 一 
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擦 除 心 片 过 程 ， 将 J-Link 连 接 到 电脑 ， 短 接 A 两 孔 约 5 秒 钟 ， 断 开 ， 然 后 拔 挥 J-Link 与 电脑 的 连 
接 。 如 果 重 新 连接 电脑 ，led 灭 挥 ， 在 设备 泄 理 中 找 不 到 任何 相关 设备 ， 则 表示 擦 除 成 功 。 


探 除 成 功 后 ， 要 进入 编程 模式 。 进 入 编程 模式 的 过 程 ， 短 接 B 两 孔 ， 连 接 接 J-Link 到 电脑 ， 至 
少 约 10 秒 名 拔 掉 USB 线 ， 断 开 B 人 处 短 接 。 再 次 插 上 电脑 ， 在 设备 管理 中 有 未 知 设备 出现 ， 则 
表示 进入 编程 模式 成 功 。 


5 - 鸯 | 便 扒 设备 
> 司 处 理 器 
4 3 磋 盘 驱动 器 
二 Ej Generic- Multi-Card USB Device 
: ed Es WDC WDS000AAKX-60U6A SCSI Disk Device 
b 二 电池 
4 本 诺 口 (COM 和 LPT) 


如 果 已 经 安装 了 AT91-ISP， 并 且 其 驱动 运转 正常 ， 那 么 可 以 J-Link 被 识别 为 一 个 USB 转 串口 
设 各 ， 表 示 进 入 编程 模式 成 功 。 我 们 测试 有 些 电 脑 安装 之 后 驱动 会 不 正确 ， 请 换 一 台电 脑 重 
试 。 只 有 了 驱动 正常 ， 入 下 图 所 示 ， 才 可 以 烧 入 固件 。 


-天 声言、 视频 和 游戏 控制 器 
> - 风 筷 标 和 其他 指针 设备 
4 - 晶 通用 让 行 总 线 控 制 器 PE 
: | ee -… 早 atm6124.Sys ATMEL AT91wo000x Test Board 
i … 晶 Generic USB Hub 
ke … 蝇 Generic USB Hub 
… 晶 IntelfR) 6 Series/C200 Series Chipset Family USB Enhanced 
i … 蝇 IntelfR) 6 Series/C200 Series Chipset Family USB Enhanced 
i … 蝇 Texas Instruments USB Root Hub 
a 一 蝇 Texas Instruments XHCI Controller 





双击 SAM-PROG v2.4, 运行 烧 录 软件 如 下 。 
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将 J-Link 通 过 USB 线 与 PC 机 连接。 此 时 ，SAM-PROG v2.4 软 件 中 的 Write Flash 按钮 将 变 为 
有 效 。 注 意 ， 先 打开 SAM-PROG v2.4， 再 连接 J-LINK 与 PC 机 。 


点 击 Write Flash 按 钮 ， 烧 录 国 件 ， 竺 烧 录 完成 后 ，Active Connection : 将 变 为 1。 


如 果 遇 到 问题 是 write flash 一 下 都 是 灰色 的 ， 那 么 可 能 是 AT91-ISP 驱 动 未 正 彰 运行， 无 法 J- 
Link 识 别 为 USB 转 串口 设备 。 换 台电 脑 就 可 以 。 


至 此 ,J-LINK 的 固件 已 经 更 新 完毕 ， 正 常情 况 下 ， 连 接 电 脑 与 J-LINK 时 ，JLINK 的 指示 灯 将 闪 
炸 。 如 果 J-Link 驱 动 安 装 正 确 ， 那 么 LED 最 后 常 绿 。 


Keil 5 下 面 J-Link 失 戏 的 问题 


在 Keil 5 下 面 ， 老 版 本 的 J-Link 可 能 无 法 使 用 ， 出 现下 面 的 提示 。 这 个 时 候 需要 升级 J-Link 回 
件 。 参 考 文档 MDK5 安 装 与 JLINK 问 题解 决 方法 (支持 代码 自动 补 全 ) 
有 J-Link V4.54a Warning 


The connected emulator 1 3 J-Link clone. 


SEGGER J-Link software may only be used with original 
SEGGER products and authorized OEh products. 


The use of the lcensed zoftware to operate SEGGER product clones 1s prohibited and lllegal. 


DK | 





Crazepony 上 位 机 使 用 手册 


作者 : nieyong 


Crazepony 四 轴 飞 行 器 提供 一 个 Windows PC 端 上 位 机 软件 ， 用 于 查看 姿态 数据 ， 调 节 PID 等 
操作 。 该 上 位 机 使 用 C# 编 写 ， 源 代码 暂时 没有 开源 。 下 面 介 绍 上 位 机 的 配置 和 使 用 。 


御 先 ， 从 百度 云 衣 下 载 最 新 的 上 位 机 ， 得 到 的 文件 如 下 ， 点 击 其 中 的 可 执行 文件 ， 打 开 上 位 
机 软件 。 


一 
”本 地 磁盘 [D:) Crazepony CrazeponyV5.1 上 位 机 ma 一 





名 称 ~ 修改 日 期 关 弄 大 小 

hh source 2015/2/11 15:15 交 性 专 

HD compass 2015/2/11 15:15 2345 者 图 十 PNG... KB 
因 引 Crazepony Consale V1.0 2015/2/11 15:15 应 用 和 柱 友 193 KB 
| | Crazepony Consol®Vl.0.pdb 2015/2/11 15:15 PDB 区 件 180 KB 
| Crazepony Console , 20157/2/11 135:15 应 用 程 太 12 KB 
| | Save.contfig 2015/2/11 15:15 CONFIG 文件 1 KB 
急 | ZedGraph.dll 2015/2/11 15:15 应 用 程 太 扩 展 264 KB 
GD6 加 计 标 定 值 2015/2/11 15:15 2345 看 图 王 PNG.. 45 KB 
| | 样板 ,config a01512/11 15:15 CONFIG 区 件 9 KB 


将 Crazepony 四 轴 使 用 usb 线 连接 到 电脑 ， 并 且 安 装 usb 转 串口 驱动 〈 关 于 如 何 安 装 该 驱动 ， 
参考 《固件 烧 写 》 中 的 安 儿 cp2102 了 驱动 部 分 )。 我 的 电脑 -> 设 各 管理 -> 妆 口 (COM 和 
LPT) ， 就 可 以 看 到 Crazepony 对 应 的 串口 号 ， 例 如 下 图 为 COM3。 Crazepony 是 使 用 
CP210x 心 片 实现 的 USB 转 串口 功能 ， 所 以 会 看 到 该 串口 中 有 关于 CP210x 的 描述 。 


过 设备 管理 器 
文件 [Fi ”操作 (A ”查看 (V) ”帮助 (H) 
和 号 | 国 | 国 | 匡 册 | 虽 | 攻 号 唱 
遂 = SDWhN-20140609WR 
”DVDVCD-ROM 驱动 器 
-EE IDE ATA/ATAPI 控制 器 
; 国 处 理 器 
, . 答 电 地 


, 起 壮 D (COM 和 Lp 


;加 计算 机 


》 蚁 人 体 学 输入 设备 

”天 声言 、 视 频 和 游戏 控制 器 

， 风 局 标 和 其他 指 计 设 各 Crazepony 对 应 的 串口 ，CP210%w5 片 实现 USB 转 串口 
- 晶 通用 直行 总 绪 控 市 器 

》. 殊 图 你 设备 

; - 哪 网 阁 适 本 器 

> -本 系统 设备 

》 .而 喇 示 适 本 器 

















接 下 来 是 在 上 位 机 中 选择 Crazepony 串 口 。 步 又 如 下 图 所 示 。 如 果 提 示 串 口 已 经 和 伞 打 开 ， 可 以 
在 左上 角 的 串口 操作 中 选择 天 闭 串 口 ， 册 进行 操作 。 如 果 串 口 正 背 连 接 并 且 打 开 ， 那 么 上 位 
机 就 可 以 接收 Crazepony 的 数据 ， 晃 动 一 下 Crazepony 会 发 现 左 上 角 的 视图 在 变化 。 

间 crazepony Console VIO CC 


设置 ， 审 口 控 作 传 局 镍 标定 。 帮助 
1, 点 击 选 择 串 口 设 置 
| 地 面 站 | 若 数 设置 


COMS 


: 11l5200 





， Hone 





查看 /修改 PID 参 数 。 上 点 击 右边 的 参数 设置 ， 可 以 配置 Crazepony 的 PID 参 数 。 
todo 


监视 姿态 信息 。 电 机 右边 的 曲线 控制 ， 可 以 监视 Crazepony 的 实时 姿态 信息 。 





虽 Crazepony Console V1.0 
设置 ” 索 口 操作 “传感器 标定 ”帮助 1. 点 击 曲线 控制 ” 
主 欠 


| 地面 站 | 参数 设置 | 曲线 监控 


传 感 司 信 息 

(desired pitch Gyr oN Drie_ GyroX 

六 | desired roll GyroY Drie GyroY 

[| desired yaw Gyroz 后 | Drig_Gyroz 

三 | deslred_alt 让 ee 其 |iDrie Acch 

Baro Speed 点 ce Drie hccY 
Integ Alt | Acc_Speed cc Drie Accz 

[| IF_Speed cc Vertical Value 


仪表 ”| 状态 值 





蓝牙 无 线 调 参 


除了 使 用 usb 线 连接 上 位 机 之 外 ， 还 可 以 使 用 蓝牙 无 线 连 接 上 位 机 ， 这 样 可 以 省 去 连接 线 的 束 


“十 


可 oo 
@ 需要 要 电脑 有 蓝 1 大 牙 设 
ER 设备 查找 ， 找 到 一 个 叫 crazepony 的 设备 配对 连接 ， 配 对 码 
为 1234 
。 打开 电脑 设 


里 器 ， 查看 蓝牙 透 传 串口 号 
刚刚 


名 管理 
备 官 了 
e。 打开 上 位 机 ， 选 择 刚 刚 看 到 的 串口 号 ， 波 特 率 115200， 确 认 连 接 。 


~ 二 © 三 互让 人 
自主 呈 停 & 高 度 融 个 
作者 : nieyong 
自主 基 停 是 Crazepony 玩 家 问 得 最 多 的 问题 ， 也 是 技术 难度 最 高 的 问题 。 
首先 我 们 明确 什么 是 自主 基 停 ?下 面 是 一 位 资深 航模 玩家 对 于 上 自主 基 停 的 解释 。 


飞行 器 能 够 是 集 在 某 个 位 置 ， 在 发 生 了 偏离 之 后 能 够 目 动 校正 并 且 回 到 原来 甚 集 的 位 
置 ， 并 且 能 够 在 该 位 置 保持 足够 长 的 时 间 ， 至 少 2 分 钟 以 上 ， 那 么 我 们 认为 该 飞行 器 吓 能 
够 目 主 基 停 的 。 


飞行 器 在 空中 是 一 个 三 维 坐 标 (X,yz) 位 置 ， 涉 及 到 两 个 维 硫 的 悬 俘 。 第 一 是 在 水 平面 上 (x,y)， 
飞行 器 不 能 够 左右 或 者 前 后 漂移 。 第 二 是 在 垂下 方向 上 (又 叫 Z 轴 维度 ) ， 飞 行 右 不 能 够 发 生 
挥 局 等 现象 。 针 对 这 两 个 不 同 的 维度 ， 有 不 同 的 技术 进行 解决 。 

在 水 平面 上 ， 为 了 确定 飞行 器 的 位 置 ， 一 般 使 用 GPS 进行 定位 ， 军 内 一 般 使 用 区 流 进行 定位 
(宇内 没有 GPS 信 号 ) 。 


在 垂下 方向 上 ， 一 般 使 用 气压 计 进 行 定 高 ， 至 内 等 条 件 下 可 以 使 用 超声 波 模块 。 

性 已 ~、 > = 

朋 任 只 用 6 维 数 据 实 现 甚 堡 

否 只 使 用 3 维 加 速度 和 3 维 陀螺 仪 这 6 个 维度 的 数据 实现 目 主 其 停 ? 而 不 再 使 用 气压 计 和 GPS 


加 
。 现 在 融 我 了 解 ， 是 很 难 实现 。 因 为 只 使 用 这 个 6 维 数据 ， 无 法 知道 飞行 器 在 空中 的 绝对 坐 
， 只 能 够 由 6 维 数 据 获 得 相对 偏 移 。 没 有 绝对 坐标 ， 束 无 法 对 位 置 实现 闭环 控制 。 


亲 砷 起 


当然 ， 我 们 看 到 很 多 只 是 用 了 MPU6050 的 玩具 四 轴 ， 也 能 够 实现 一 定 程度 的 基 停 ， 但 是 那 并 
` 是 真正 意义 上 的 自主 是 停 。 


水 平面 的 定位 


室外 使 用 GPS 进 行 水 平定 位 ， 室 内 一 般 使 用 光 流 技术 (optical flow) 。 光 流传 感 器 其 实 就 是 
一 个 摄像 关 ， 安 装 在 飞行 器 上 垂直 拍摄 地 面 。 光 流 技术 就 是 要 对 拍摄 到 的 画面 进行 视 党 
理 ， 以 此 知道 相对 于 地 面 坐 标 位 置 。APM 飞 控 中 关于 光 流 传感器 的 介绍 。 
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垂直 方向 定位 


在 垂直 方向 上 ， 使 用 高 精度 气压 计 (如 MS5611) 进行 定位 。 在 飞行 器 处 于 较 低 高 度 时 ， 可 以 
使 用 超声 波 进 行 高 度 定位 。 


Crazepony 的 自动 县 停 


飞行 器 要 想 实 现 真 正章 义 的 自主 基 售 需要 有 上 自 稳 和 空中 绝对 坐标 。Crazepony 有 一 个 高 精度 气 
压 计 MS5611， 所 以 可 以 实现 Z 轴 的 自主 县 停 。 在 水 平方 向 上 ，crazepony 没 有 绝对 坐标 ， 无 法 
实现 县 俘 。 


在 Z 轴 自主 县 停 上 ，Crazepony 有 一 个 高 精度 气压 计 MS5611， 通 过 气压 传感器 采集 的 大 气压 
值 计 算出 来 ， 将 气压 传感器 采集 值 进 行 校正 后 ， 再 通过 温度 二 阶 补偿 ， 得 到 准确 的 大 气压 
值 ， 最 后 经 过 气压 转换 高 度 公 式 就 可 以 得 到 一 个 相对 于 起 飞 地 点 的 绝对 高 度 〈 参 考 气压 计 
MS5611) 。 


MS5611 气 不计 的 精度 为 10CM， 因 此 需要 融合 加 速度 计 互补 滤波 得 到 比较 合适 的 高 度 值 ，Z 轴 
速度 值 和 加 速度 值 。 用 高 度 作 外 环 ， 速 度 作 内 环形 成 高 度 双 环 PID 控 制 器 ， 调 节 输 出 油门 实现 
Z 轴 的 自主 是 停 。 高 度 融 合 在 文件 Altitude.c 中 实现 ， 高 度 双 环 PID 控 制 在 control.c 文件 中 
的 ctrlAlti() 函数 中 实现 。 


高 度 双环 PID 控 制 总 体 流程 。 








高 度 PID 2 z 和 加速 刘 控制 油门 加 速度 计 也 压 计 咒 虚 
控制 : PTD 控制 和 困 昌 采集 相 提 





明 望 商 度 


融 褒 殴 出 ZZ 
蔽 速度 


// pid and feedforward control . in ned frame 
posZErr= -(altSp - alt); 
posZVelSp = posZErr * alt_ PID.P + SpZMoveRate * ALT_FEED_FORWARD ; 
//consider landing mode 
if(altCctrlMode==LANDING) 
posZVelSp = LAND_SPEED ; 


velZ=nav .vz,; 

velZErr = posZVelSp - velzZ,; 

valZErrD = (spZMoveRate - velZ) * alt_ PID.P - (velZz - velZPrev) / dt //spZMoveRate is 
velZPrev=velzZ; 


thrustZSp= velZErr * alt vel PID.P + VvalZErrD * alt vel PID.D + thrustZInt ，; //in ned f 





在 水 平方 向 上 ， 由 于 Crazepony 没 有 绝对 坐标 ， 使 用 3 维 加 速度 和 3 维 陀 螺 仪 这 6 个 维度 的 数据 
进行 双环 PID 控 制 形成 一 个 自 稳 系统 ， 可 实现 短 时 间 定 点 脱 控 甚 停 ， 但 是 受 误差 影响 产生 偏 
离 ， 没 有 水 平 绝对 坐标 束 无 法 回 到 原来 的 位 置 ， 所 以 Crazepony 是 无 法 实现 正 真 意义 上 目 动 有 
停 的 。 


Z 轴 姑 信 -县 停 油 门 基 准 值 


在 Z 轴 县 停 代 码 中 ， 定 义 了 一 个 县 停 油 门 基 准 值 HovER_THRU ， 该 值 决定 着 飞行 器 脱 控 姑 停 的 
时 候 需 要 的 油门 大 小 。 对 其 停 起 到 至 关 重 要 的 作用 。 在 版 本 9bf1e83f 之 后 ， 该 安定 义 由 画 
数 estimateHoverThru() 人 代替， 根据 当 前 电池 电 丰 大 小 ， 输 出 对 应 的 油门 甚 停 基准 值 ， 能 够 彻 
底 解 决 充满 电 之 后 第 一 次 飞行 直接 往 上 冲 的 问题 。 


油门 基准 值 的 选取 对 呈 集 是 至 关 重 要 的 。 例 如 ， 我 们 换 了 一 批 氢 力 更 大 的 电机 ， 那 么 在 飞行 
器 重量 不 变 的 情况 下 ， 使 用 原来 的 基准 值 融 会 出 现 脱 控 之 后 一 下 往 上 飞 的 情况 。 这 个 时 候 ， 
我 们 融 需 要 将 该 值 改 小 ， 以 此 适应 这 批 次 扭力 大 的 电机 。 


甚 停 油门 基准 值 将 会 站 接 影 响 Z 轴 基 停 ， 选 取 不 当 或 者 系统 参数 发 生变 化 时 ， 束 会 出 现 往 上 飞 
或 者 挥 高 的 问题 。 这 里 的 系统 参数 发 生变 化 ， 包 括 电 池 电 力 变 化 ， 飞 机 重量 改 交 ， 电 机 持 力 
变化 等 。 如 果 使 用 固定 值 ， 在 电池 充满 电 之 后 ， 会 出 现 起 飞 之 后 往 上 冲 的 问题 。 所 以 在 版 
本 9bf1e83f 之 后 ， 该 县 停 油 门 基 准 值 由 函数 estimateHoverThru() 和 输出。 根据 电池 电压 不 同 ， 
使 用 不 同 的 油门 基准 值 。 


float estimateHoverThru(void)t 
float hoverHru = 0.55f， 


// 电 池 电 压 检 测 
Battery.BatteryAD = GetBatteryAD( ) ; 
Battery.BatteryVal = Battery.Bat_K * (Battery.BatteryAD/4096.0) * Battery.ADRef,;// 实 阿 


if(Battery.BatteryVal > 4.05)1{ 
hoverHru = -0,.35f， 

Yelse if(Battery.BatteryVal > 3.90){ 
hoverHru = -0.40f; 

Yelse if(Battery.BatteryVal > 3.80)1{ 
hoverHru = -0,.45f， 

Yelse if(Battery.BatteryVal > 3.70){ 
hoverHru = -0.50f， 

Yelsef 
hoverHru = -0.55f， 

hy 


return hoverHru ; 





Z 轴 姑 俘 -最 小 油门 值 


Re 我 们 还 为 Crazepony 设 定 了 一 个 最 小 的 油门 输出 值 THR_MIN ， 这 
羊 能 够 限制 最 大 的 下 降 速 度 。 可 以 避免 下 降 速度 过 快 ， is 


限定 最 小 的 油门 输出 值 THR_MIN 本 来 是 为 了 解决 下 降 过 快 的 问题 ， Jieiosateagui 
例如 充电 后 第 一 次 飞行 ， 由 于 动力 输出 强劲 ， 如 果 这 个 最 小 油门 输出 值 设置 得 过 大 ， 那 么 即 
使 笃 摇 杆 油门 拉 到 了 最 低 ， 飞 机 也 会 一 直 往 上 冲 。 在 版 本 7ee226a 之 后 ， iti 
数 estimateMinThru() ， 将 输出 和 当前 电池 电压 挂钩 ， 能 够 解决 往 上 冲 下 拉 油 门 时 无 法 受 控 的 


问题 。 


float estimateMinThru(void)t{ 
float minThru = -0.55f， 


// 电 池 电 压 检 测 
Battery.BatteryAD = GetBatteryAD( ) ; 
Battery.BatteryVal = Battery.Bat_K * (Battery.BatteryAD/4096.0) * Battery.ADRef;// 实 阿 


if(Battery.BatteryVal > 4.05)1{ 
minThru = -0.30f; 

Yelse if(Battery.BatteryVal > 3.90){ 
minThru = -0.40f; 

Yelsef 
minThru = -0.55f; 


return minThru; 





2.4G 天 线 设 计 及 珀 控 距 留 


2.4G 大 线 设 计 


2.4G 天 线 设计 ， 下 搂 影 响 到 遥控 的 距离 。 我 们 现在 使 用 了 陶 八 天 线 ， 尽 量 减少 天 线 所 占 面 
积 。 


带 PA 的 发 射 模块 


遥控 器 上 使 用 带 有 PA 的 发 射 模 块 ， 可 以 将 2.4G 遥 控 的 距离 扩大 到 100 米 五 石 。 


摄像 头 和 图 传 


作者 : nieyong 


很 多 小 伙伴 都 有 在 微型 四 轴 上 悬挂 摄像 头 或 者 图 传 模 块 的 需求 。Crazepony 软 认 是 不 带 摄 像 头 
的 。 下 面 我 们 整理 了 一 些微 型 摄像 头 图 传 模 块 ， 方 便 基 挂 到 小 四 轴 上 。 


Crazepony 黑 认 的 载重 在 20g 左 右 。 如 果 换 成 820 电 机 载重 可 以 提升 。 


5.8G 图 传 摄 像 头 一 体 化 模块 


该 模块 带 有 5.8G 图 传 和 微型 摄像 头 ， 只 有 6g 左 右 ， 可 以 悬挂 到 Crazepony 小 四 轴 下 面 。 该 模 
块 可 以 从 淘宝 大 力 模 型 店铺 购买 到 ， 如 下 所 示 。 





5.8G 模 块 需要 配备 相应 的 5.8G 接 收 机 才能 够 将 图 传 数 据 接 收 。 


wifi 图 传 摄像 头 一 体 化 模块 


该 模块 带 有 wi 放 图 传 和 微型 摄像 头 ， 只 有 12g。 配 上 相应 的 手机 APP 融 能 够 实时 图 传 。 


淘宝 购买 地 址 。 





摄像 关 录 像 模 块 


如 果 不 想 要 图 传 ， 只 需要 挂 载 摄 像 头 做 录像 担 照 ， 我 们 可 以 使 用 单一 的 摄像 头 模块 。 


我 们 测试 过 Crazepony 可 以 携带 10g 左 右 的 微型 摄像 头 。 该 摄像 头 只 有 大 拇指 大 小 ， 可 以 插入 
SD 卡 保存 录像 图 像 。 该 摄像 头 只 需要 从 Crazepony 机 身 板 上 供电 即 可 。 


Crazepony 通 信 协 议 


作者 : nieyong 


2.4G 遥 控 器 NRF24L01 


Crazepony 机 身上 2.4G 射 频 芯 片 NRF24L01 和 主 控 STM32 使 用 SPI 总 线 连接 在 一 起 。 


Crazepony 遥 控 器 上 ， 我 们 使 用 了 市 面 上 标准 排 插 接口 的 NRF24L01 模 块 。 


手机 APP 通 信 协 议 


Crazepony APP 和 飞 控 之 间 通 信 协 议 使 用 了 MWC 飞 挥 协议 (MSP，Multiwii Serial 
Protocol) ， 详 见 MSP 协 议 格 式 。 
MWC 协 议 规定 了 飞 控 和 上 位 机 (或 者 手机 APP) 信息 交流 的 基本 格式 。 


MWC 具 体 实现 ， 可 以 查看 Crazepony 的 Android APP 源 代码 中 的 protocol.java 文件 。 


四 轴 飞 行 右 平衡 稳定 调试 
作者 : nieyong 


下 面 介 绍 Crazepony 四 轴 飞 行 器 平衡 稳定 的 调试 方式 ， 这 些 调试 的 方式 同时 也 可 以 用 于 其 它 四 
轴 的 调 1 O 


固定 调试 


可 以 将 飞行 器 用 绳子 栓 住 ， 然 后 调试 最 基本 的 平衡 和 稳定 。 这 样 一 般 可 以 获得 一 个 大 概 的 PID 
值 。 只 有 这 步调 斌 基本 稳定 ， 才 会 进行 后 面 更 加 精细 深入 的 调试 。 


栓 住 飞行 妖 的 办 法 有 很 多 ， 例 如 用 两 根 绳 子 挫 在 两 个 句 膀 上 ， 或 者 用 一 根 强 子 料 飞行 器 底部 
控 住 。 下 面 是 Crazepony 早 期 平衡 调试 的 照片 。 





无 线 调 试 


使 用 蓝牙 模块 ， 在 飞行 器 飞行 的 过 程 中 实时 将 希望 观察 的 数据 传 回 上 位 机 。 


Crazepony 开 源 四 轴 飞 行 二 


Crazepony 动 力 效 率 和 续航 时 间 


作者 : nieyong 


很 多 人 会 间 ， 充 一 次 电 ，Crazepomy 能 够 飞 多 久 呢 ? 才 6 分 钟 ， 要 是 能 够 飞 上 上 10 分钟 融 好 了 。 
为 什么 Crazepony 只 能 够 飞 6 分 钟 ， 如 何 才 能 够 提高 飞机 的 动力 效率 ， 提 升 飞行 时 间 ? 


那么 这 里 我 们 分 享 一 些 我 们 调试 实验 的 结果 和 经 验 ， 对 大 家 有 所 帮助 。 


Ni p= 
电池 容量 
Crazepony 的 电池 容量 ， 在 5.2 版 本 由 原来 的 380mAh 换 成 了 650mAh， 能 够 提供 更 多 的 动力 能 
源 。 


当然 ， 并 不 是 一 味 的 增加 电池 容量 束 能 够 增加 续航 能 力 。 更 大 的 电池 容量 需要 有 时 重 更 大 的 
电池 ， 本 喘 融 增 加 了 飞机 的 负重 ， 所 以 电池 容量 一 定 要 在 合理 的 沧 围 内 。 


由 机 & 奖 叶 的 选 型 


我 们 测试 发 现 ， 电 机 和 桨 叶 的 选 型 对 续航 能 力 的 提升 最 为 显 闭 。 


下 面 是 同样 的 650mAh 电 池 充 满 电 的 情况 下 ， 使 用 两 种 不 同 桨 叶 的 续航 能 力 对 比 结果 。 以 下 测 
试 在 720 电 机 下 进行 。 


小 西 轴 75mm 浆 叶 
(匹配 820 720 空 心 杯 ) 
+ 径 lmm 本 


| 
机 | 


] 





使 用 Crazepony 原 配 75mm 浆 时， 电机 发 热 发 溉 明星， 飞行 时 长 6min。 


动力 效率 和 续航 时 间 161 





使 用 parrot 的 mini drone 原 配 66cm 桨 叶 ， 电 机 明显 发 热 减 少 ， 飞 行 时 长 7min。 





为 什么 原配 的 75mm 桨 叶 动 力 效 率 会 低 很 多 呢 ?我 们 仔细 分 析 后 发 现 ，75mm 桨 叶 本 来 束 比 
66cm 桨 叶 长 ， 而 且 叶 面 受 力 面积 大 ， 最 重要 的 是 曙 距 要 大 ， 所 有 的 这 些 都 要 求 有 强劲 动力 的 
电机 和 它 相 匹配 (也 束 是 小 KV 值 的 电机 ) 。 而 我 们 的 720 空 心 杯 单机 本 来 束 是 高 KV 值 电机 ， 
和 该 桨 叶 的 匹配 并 不 是 非 弟 理想 。 


820 空 心 杯 电机 
现在 我 们 使 用 的 720 空 心 杯 电 机 ， 在 连续 飞行 2min 之 后 ， 就 会 发 汤 厉 沽 。 这 主要 是 由 于 720 电 
机 的 动力 有 限 ， 带 动 46g 的 Crazepony 上 比较 吃力 。 


我 们 有 尝试 使 用 820 空 心 杯 电 机 ， 该 电机 直径 为 8mm， 动 力 非 弟 强劲 ， 续 航 能 力 更 强 。 在 解决 
了 电机 委 配 的 问题 之 后 ， 我 们 会 默认 使 用 该 型 号 电机 。 


Crazepony 开 源 四 轴 飞 行 二 





动力 效率 和 续航 时 间 163 


四 轴 飞行 器 算法 讲解 


章 主 要 是 Crazepony 核 心 的 算法 讲解 。 其 中 最 重要 的 融 是 姿态 解 算 部 分 内 容 。 


计 


姿态 解 算是 指 把 陀螺 仪 、 加 速度 计 、 罗 和 瘟 等 数据 融合 在 一 起 ， 得 出 飞行 器 的 宪 中 姿态 ， 也 叫 
做 姿态 融合 。 姿 态 解 算 的 过 程 ， 涉 及 到 传感器 数据 读 取 和 与 滤波 ， 四 元 数 与 施 转 ， 姿 态 解 算 框 
染 ， 长 期 融合 /快速 融合 
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芝 态 所 异 


作者 : nieyong 


姿态 解 算 的 英文 是 attitude algorithm， 也 叫做 姿态 分 析 ， 姿 态 估 计 ， 姿 态 融 合 。 姿 态 解 算 是 指 
把 陀螺 仪 、 加 速度 计 、 罗 瘟 等 的 数据 融合 在 一 起 ， 得 出 飞行 器 的 空中 姿态 。 


飞行 器 从 陀螺 仪 的 三 轴 角 速度 通过 四 元 效法 得 到 的 众 仰 、 偏 裔 和 滚 转角 ， 这 是 快速 解 算 ， 结 
合 三 轴 地 磁 和 三 轴 加 速度 得 到 漂移 补偿 和 深度 解 算 。 


是 用 来 挡 述 一 个 刚体 的 固 连 坐标 系 和 参考 坐标 系 之 间 的 角 位 置 天 系 ， 有 有 一举 效 学 表示 方 
法 。 很 常见 的 束 是 欧 拉 角 ， 四 元 数 ， 答 阵 ， 轴 和 骨 。 


姿态 解 算 需 要 解决 的 是 四 轴 飞 行 器 和 地 球 的 相对 姿态 问题 。 地 球 的 坐标 系 又 叫做 地 理 坐 标 

系 ， 是 固定 不 变 的 。 正 北 ， 正 东 ， 正 同上 构成 了 这 个 坐标 系 的 X，Y，Z 轴 ， 我 们 用 坐标 系 R 表 
示 。 四 轴 飞 行 器 上 固定 着 一 个 坐标 系 ， 用 坐标 系 r 表 示 。 那 么 我 们 融 可 以 用 欧 拉 角 ， 四 元 效 等 
来 搞 述 r 和 R 的 角 位 置 天 系 。 这 融 是 四 轴 飞 行 器 姿态 解 算 的 效 学 模型 和 基础 。 


(0, 1.0) 地 磁 回 重 





(0,0,-9) 
重力 加 速度 同 量 


地 球 坐 标 系 R( 地 理 坐 标 系 ) 


角 位 置 天 系 测量 


如 上 所 说 ， 地 球 坐 标 系 R 是 固定 的 。 四 轴 飞 行 器 上 固定 一 个 坐标 系 r， 这 个 坐标 系 r 在 坐标 系 R 
中 运动 。 那 么 如 何 知 道 坐标 系 r 和 坐标 系 R 的 角 位 置 天 系 呢 ， 也 融 是 竹 么 知道 飞行 器 相对 于 地 
球 这 个 固定 坐标 系 R 转 动 了 一 下 航向 ， 或 者 侧 翻 了 一 下 机 有 身 ， 或 者 挥 头 下 载 。 这 珊 是 传感器 需 
要 测量 的 数据 ， 传 感 右 乌 插 陀 蝶 仪 ， 加 速度 计 ， 人 磁力 计 。 通 过 获得 这 些 测量 数据 ， 得 到 坐标 
系 r 和 坐标 系 RR 的 角 位 置 关 系 ， 这 束 是 姿态 解 算 。 


安 态 的 数学 表示 方法 


作者 : nieyong 


容 态 有 多 种 数学 表示 方式 ， 生 见 的 是 四 元 数 ， 欧 拉 角 ， 赴 阵 和 轴 角 。 他 们 各 目 有 其 目 身 的 优 
点 ， 在 不 同 的 领域 使 用 不 同 的 表示 方式 。 在 四 轴 飞 行 器 中 使 用 到 了 四 元 数 和 了 欧 拉 角 。 


四 元 数 
四 元 数 是 由 爱尔兰 数学 家 威廉 . 卢 云 :哈密 琐 在 1843 年 发 现 的 数学 概念。 从 明确 地 角度 而 言 ， 四 


元 数 是 复数 的 不 可 交换 延 件 。 如 把 四 元 数 的 集合 考虑 成 多 维 实数 空间 的 话 ， 四 元 数 兢 代表 着 
一 个 四 维 空间 ， 相 对 于 复数 为 二 维 空 间 。 


四 元 数 大 量 用 于 电脑 绘图 (及 相关 的 图 像 分 析 ) 上 表示 三 维 物件 的 旋转 及 方位 。 四 元 数 亦 见 
于 控制 论 、 信 号 处 理 、 姿 态 控 制 、 物 理 和 轨道 力学 ， 都 是 用 来 表示 旋转 和 方位 。 


相对 于 另 几 种 旋转 表示 法 《起 阵 ， 欧 拉 角 ， 轴 角 ) ， 四 元 数 具有 某 些 方面 的 优势 ， 如 速度 更 
快 、 提 供 平滑 插值 、 有 效 如 免 万 向 锁 问 题 、 存 储 空间 较 小 等 等 。 


以 上 部 分 反目 维基 百科 -四 元 数 。 
欧 拉 角 
采 昂 哈 德 : 欧 拉 用 欧 拉 角 来 朱 述 刚体 在 三 维 欧 几 里 得 空间 的 取 癌 。 对 于 在 三 维 实 间 里 的 一 个 参 


考 系 ， 任 何 坐 标 系 的 取向 ， 都 可 以 用 三 个 欧 拉 角 来 表现 。 参考 系 又 称 为 实验 军 参 考 系 ， 是 静 
止 不 动 的 。 而 坐标 系 则 固定 于 刚体 ， 随 着 刚体 的 旋转 而 旋转 。 


站 
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以 上 部 分 摘 目 维基 百科 -网 打 角 。 下 面 我 们 通过 图 例 来 看 看 欧 拉 角 是 如 何 产 生 的 ， 并 且 分 别 对 
应 应 哪个 角度 。 





绪 z 轴 旋 转 得 到 以 角 线 旋 转 之 后 的 x 轴 旋 转 得 到 B 前 贱 旋 转 之 后 的 z' 轴 旋 转 得 到 角 


安 态 解 算 为 什么 要 用 四 元 效 和 了 欧 拉 角 


姿态 解 算 的 核心 在 于 旋转 ， 一 般 旋 转 有 4 种 表示 方式 : 答 阵 表示 、 欧 拉 角 表示 、 轴 和 角 表 示 和 四 
元 数 表示 。 和 矩阵 表示 适合 变换 同 量 ， 欧 拉 角 最 直观， 轴 和 角 表 示 则 适合 几何 推导 ， 而 在 组 合 旋 
转 方面 ， 四 元 数 表示 最 佳 。 因 为 姿态 解 算 需要 频繁 组 合 旋转 和 用 旋转 变换 向 量 ， 所 以 采用 四 
元 数 你 存 组 合 姿态 、 辅 以 答 阵 来 变换 疝 量 的 方 宁 。 


总 结 来 说 ， 在 crazepony 中 ， 姿 态 解 算 中 使 用 四 元 数 来 保存 飞行 器 的 姿态 ， 包 括 旋转 和 方位 。 
在 获得 四 元 数 之 后 ， 会 将 其 转化 为 欧 拉 角 ， 然 后 输入 到 姿态 控制 算法 中 。 


姿态 控制 算法 的 输入 参数 必须 要 是 欧 拉 角 。AD 值 是 指 MPU6050 的 陀螺 仪 和 加 速度 值 ，3 个 维 
大 的 陀螺 仪 值 和 3 个 维度 的 加 速度 值 ， 每 个 值 为 16 位 精度 。AD 值 必须 先 转化 为 四 元 数 ， 然 后 
通过 四 元 数 转 化 为 欧 拉 角 。 这 个 四 元 数 可 能 是 软 解 ， 主 控 心 片 (STM32) 读 取 到 AD 值 ， 用 软 
件 从 AD 值 算 得 ， 也 可 能 是 通过 MPU6050 中 的 DMP 硬 解 ， 主 控 芯 片 (STM32) 直接 读 取 到 四 
元 数 。 具 体 参 考 《MPU60x0 的 四 元 数 生成 方式 介绍 》。 


下 面 融 是 四 元 数 软 解 过 程 ， 可 以 由 下 面 这 个 框图 表示 : 


Crazepony 开 产 四 轴 飞 行 妍 


MPU6050 


400kHz 的 12C 接口 





扩展 阅读 -四 元 数 的 运算 

下 面 介 绍 一 下 四 元 数 ， 然 后 给 出 几 种 旋转 表示 的 转换 。 这 些 运算 在 crazepony 的 代码 中 都 会 遇 
到 。 

四 元 数 可 以 理解 为 一 个 实数 和 一 个 向 量 的 组 合 ， 也 可 以 理解 为 四 维 的 向 量 。 这 里 用 一 个 圈 表 
示 dq 是 一 个 四 元 数 (很 可 能 不 是 规范 的 表示 方式 ) 。 

本 一 上 T 

4=IW,VvI=Iw x y 过 


四 元 数 的 长 度 ( 模 ) 与 普通 向 量 相 似 。 





| 2 2 2 
-yw ix+y + 
下 面 是 对 四 元 数 的 单位 化 ， 单 位 化 的 四 元 数 可 以 表示 一 个 旋转 。 








he xX y > 
q| ||ql| lq q 


四 元 数 相 乘 ， 施 转 的 组 合 束 靠 它 了 。 
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d 0 一 4d1d4 > 
WW Any Sy 
| Xo 二 Wi1X2 十 X1W2 二 Vi1Z2 一 2 yY2 
yo 三 Wi1yV2 一 X1Z2? 十 V1W2 十 之 1X? 
之 0 二 W1Z2? 十 X1V2 一 V1X2 十 之 W, 
旋转 的 “ 轴 角 表示 " 转 “ 四 元 数 表示 "。 这 里 创造 一 个 运算 q(w,9)， 用 于 把 绕 单位 向 量 w 转 9 角 的 族 
转 表示 为 四 元 数 。 
ee 村 时 aa 
lw,6I 一 dl(w,0)=lcos( 二 ) ,WwWw:Ssin( 二 )| 
了 2 

通过 q(w 6)， 引 伟 出 一 个 更 方便 的 运算 q(f ti。 有 时 需要 把 向 量 f 的 方向 转 到 向 量 t 的 方向 
运算 就 是 生成 表示 对 点 旋转 的 四 元 数 的 (后 面 会 用 到 ) 


a(F ,= (Lt ,atan2(fxil, FE)) 
天 > 


然后 是 "四 元 效 表 示 " 转 "和 炬 阵 表 示 "。 再 
到 ) 。 


次 创造 运算 ， 用 R(q) 和 表示 四 元 数 q 对 应 的 算 阵 《后 面 用 


1-2yY-2z” 2xy-2wz 2xz+2wy 
” 2VZz-2WX 


4 一 及 (9g)=| 2xy+2wz 1-2x“ 一 2z 
2xz-2wVy 2yz+2wx 1-2x°-2y 


多 个 旋转 的 组 合 可 以 用 四 元 数 的 乘法 来 实现 。 
RIG) Rdi)= 及 (di 9 


“四 元 数 表示 ” 转 “ 欧 拉 角 表示 ”。 用 于 显示 。 


4 一 [9.0p| 
一 22 
0=arcsin(2wy—2zxX) 
ed i 
: 偏 航 角 (yaw),z 轴 
: 俯仰 角 (pitch),y 轴 
: 滚 转 角 (roll),x 轴 





作者 : nieyong 


也 虹 仪 


陀螺 仪 ， 测 量 角 速度 ， 具 有 总 动 态 特性 ， 但 是 它 是 一 个 间接 测量 角度 的 器 件 ， 它 测量 的 是 角 
度 的 导数 ， 角 速度 ， 要 将 角速度 对 时 间 积 分 才能 得 到 和 角度。 

如 果 这 个 世界 是 理想 的 ， 美 好 的 ， 那 我 们 的 问题 到 此 束 解 决 了 ， 不 过 很 遗憾 ， 现 实 是 残酷 
的 ， 误 看 的 引入 ， 使 得 积分 出 现 了 问题 。 


假设 陀螺 仪 固 定 不 动 ， 理 想 角 速度 值 是 0dps(degree per second)， 但 是 有 一 个 偏 置 0.1dps 加 
在 上 面 ， 于 是 测量 出 来 是 0.1dps， 积 分 一 秒 之 后 ， 得 到 的 角度 是 0.1 度 ，1 分 钟 之 后 是 6 度 ， 还 
能 忍受 ， 一 小 时 之 后 是 360 度 ， 转 了 一 图， 也 就 是 说 ， 陀 曙 仪 在 短 时 间 内 有 很 大 的 参考 价值 。 


使 用 陀螺 仪 获得 角度 ， 一 定 要 考虑 积分 误差 的 问题 。 
加 速度 计 


加 速度 计 可 以 测量 加 速度 ,包括 重力 加 速度 ,于 是 在 静止 或 匀速 运动 的 时 候 , 加 速度 计 仅仅 测量 的 
是 重力 加 速度 ,而 重力 加 速度 与 刚才 所 说 的 R 坐 标 系 是 固 连 的 ,通过 这 种 关系 ,可 以 得 到 加 速度 计 
所 在 平面 与 地 面 的 角度 关系 


但 是 加 速度 计 和 石 是 绕 厦 重力 加 速度 的 轴 转 动 , 则 测量 值 不 会 改变 ,也 融 是 说 无 法 感知 这 种 水 平 放 
转 。 


MPU6050 效 态 测 量 的 两 种 万 法 


MPU-60x0 是 9 轴 运 动 处 理 传 感 器 。 它 集成 了 3 轴 MEMS 陀 螺 仪 ，3 轴 MEMS 加 速度 计 ， 以 及 一 
个 可 扩展 的 数字 运动 处 理 器 DMP (Digital Motion Processor) ， 可 用 1I2C 接 口 连接 一 个 第 三 方 
的 数字 传感器 ， 比 如 磁力 计 。 扩 展 之 后 就 可 以 通过 其 12C 或 SPI 接 口 输出 一 个 9 轴 的 信号 。 


MPU-60x0 对 陀螺 仪 和 加 速度 计 分 别 用 了 三 个 16 位 的 ADC， 将 其 测量 的 模拟 量 转 化 为 可 输出 
的 数字 量 。 在 Crazepony-ll 上 ， 测 试 了 软件 解 算 四 元 数 ， 然 后 通过 四 元 数 解 算 姿 态 角 这 种 实现 
方式 ， 其 实 总 的 来 说 ， 并 没 感觉 36MHz 的 主 控 压 力 有 多 大 ， 没 有 出 现 机 身 不 稳 ， 卡 死 的 情 
部 。 


Crazepony 开 源 四 轴 飞 行 二 


MPU6050 


400kHz 的 12C 接口 





同时 ， 本 着 务实 的 态度 ， 我 们 也 测试 了 MPU6050 的 硬 解 四 元 数 ， 即 从 IIC 总 线 上 读 到 的 数据 不 
再 是 MPU60x0 的 AD 值 ， 而 是 通过 初始 化 对 DMP 引 警 的 配置 ， 从 IC 总 线 上 读 到 的 直接 就 是 四 
元 数 的 值 ， 从 而 跳 过 了 程序 通过 AD 值 计算 四 元 数 这 个 看 起 来 繁琐 的 步骤 。 测 试 结果 是 ， 机 和 映 
反应 的 确 要 比 之 前 反应 灵活 ， 最 关键 的 一 点 是 ， 这 样 得 出 的 偏 航 角 (Yaw) 很 稳 很 稳 ， 基 本 不 
会 漂移 或 者 说 漂移 小 到 了 可 以 容忍 的 地 步 。 


最 后 ，MPU60x0 的 强大 之 处 不 仅 于 此 ， 它 支持 一 个 从 lIC 接 口 ， 可 以 外 部 接 上 一 个 磁力 计 ， 如 
HMC5883， 这 样 一 来 ，DMP 引 擎 可 以 直接 输出 一 个 绝对 的 方向 安 态 ， 即 能 够 输出 一 个 带 东 西 
南北 的 姿态 数据 包 ， 很 厉害 的 样子 。 在 Crazepony-ll 第 四 版 将 会 加 上 这 样 一 个 磁力 计 ， 相 信 它 
再 也 不 会 迷路 了 ~~ 


MPU6050 


400kHz 的 |2C 接口 
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山 


秦 永 元 《惯性 导航 》 衰 信 、 郑 锚 的 《 捷 联 式 惯 性 导航 原理 》， 邓 正隆 的 《惯性 技术 》 


软件 安 态 解 算 


作者 : 路 洋 
文中 有 很 多 word 下 编辑 的 公式 尚未 加 入 ， 需 要 继续 完善 


使 用 MPU6050 人 硬件 DMP 解 算 姿 态 是 非常 简单 的 ， 下 面 介 绍 由 三 轴 陀 螺 仪 和 加 速度 计 的 值 来 使 
用 四 元 数 软 件 解 算 姿态 的 方法 。 


我 们 先 来 看 看 如 何 用 欧 拉 角 描述 一 次 平面 旋转 (坐标 变换 ) : 





杖 标 对 加 的 变换 尖 < 对 


设 坐 标 系 绕 旋 转 a 角 后 得 到 坐标 系 ,在 空间 中 有 一 个 矢量 在 坐标 系 中 的 投影 为 ,在 内 的 投影 为 
于 旋转 绕 进 行 ， 所 以 Z 坐 标 未 变 ， 即 有 。 

r=OA4d+AB+BC 

~ ODecosat+BDsinea + BF sn ea 

=FnCcoso+rsin eo 

ry2 = DE— AD 

~ DF cosa—ODsina 

=FnCcose — ODsine 

=FnCoso — Fsine 

Fz2 = 产 1 


转换 成 矩阵 形式 表示 为 : 


fx?2 cos@e sin@ 0 rr 
六 :| 王 | 一 SI cose 0 
>1 U U ] >1 


整理 一 下 
Pa ps cosw sineg 0 
1 2 et z 
P 一 | 六 "= 3 旋转 阵 C =| 一 sin@g cosw 0 
Fzl Fz2 0 1 


所 以 从 旋转 到 可 以 写成 
上 面 仅 仅 是 绕 一 根 轴 的 旋转 ， 如 果 三 维 空间 中 的 欧 拉 和 角 旋 转 要 转 三 次 : 


O— VYazn oy OO YY ER OY 7 TM OO) Wp, 


cosy 0 —siny|l 0 0 lcosw —sing 0 
C=GCC=I 0 1 0 10 cos6 sinollsing cosw 0 
sny 0 cosy 10 -sing cos@| 0 0 ] 


COSY COSU/ + SIN YSINWSINGO 一 cOS7YSIIWTSI7YCcosSWwSID —sinycoso 
二 shy coso COSU/ COSO sn 


sn yeosw—cosysinwsingd —sinysinw—cosycoswsind cosycoso 


上 面 得 到 了 一 个 表示 旋转 的 方向 余弦 矩阵 。 
不 过 要 想 用 欧 拉 角 解 算 安 态 ， 其 实 我 们 套用 欧 拉 角 微 分 方程 融 行 了 : 


| 


e COSO 


WwW 


, -—l 2 
cosO sinysing cosysing Cp 





0 cosOcosy —sinycosO| ®| @r,s 


0 Sin 7 COS7Y COSO ziz | 


上 式 中 左 侧 ,, 是 本 次 更 新 后 的 欧 拉 角 , 对 应 row,pit,yaw。 右 侧 ， 是 上 个 周期 测算 出 来 的 角 

度 ，，， 三 个 角速度 由 直接 安装 在 四 轴 飞 行 器 的 三 轴 陀 螺 仪 在 这 个 周期 转动 的 角度 ， 单 位 为 
缴 度 ， 计 算 间 隔 时 T 陀 螺 角 速度 ， 上 比如 0.02 秒 0.01 弧 度 / 秒 =0.0002 弧 度 。 间 因此 求解 这 个 微分 
方程 就 能 解 算出 当前 的 欧 拉 角 。 


前 面 介 绍 了 什么 是 欧 拉 角 ， 而 且 欧 拉 角 微分 方程 解 算 姿 态 关 系 简 单 明 了 ， 概 念 直观 容易 理 
解 ， 那 么 我 们 为 什么 不 用 欧 拉 角 来 表示 旋转 而 要 引 人 和 人 四 元 数 呢 ? 

一 方面 是 因为 欧 拉 角 微 分 方程 中 包含 了 大 量 的 三 角 运 算 ， 这 给 实时 解 算 带 来 了 一 定 的 困难 。 
而 且 当 俯仰 角 为 90 度 时 方程 式 会 出 现 神奇 的 “GimbalLock”。 所 以 欧 拉 角 方 法 只 适用 于 水 平 次 
态 变 化 不 大 的 情况 ， 而 不 适用 于 全 姿态 飞行 器 的 姿态 确定 。 

四 元 数 法 只 求解 四 个 未 知 量 的 线性 微分 方程 组 ， 计 算 量 小 ， 易 于 操作 ， 是 比较 实用 的 工程 方 
法 。 

我 们 知道 在 平面 (x,y) 中 的 旋转 可 以 用 复数 来 表示 ， 同 样 的 三 维 中 的 旋转 可 以 用 单位 四 元 数 来 
描述 。 我 们 来 定义 一 个 四 元 数 : 


一 


q=a+ u =qo+qi+q2j+qk 


我 们 可 以 把 它 写 成 ,其 中 ,。 那 么 是 矢量 ， 表 示 三 维 空间 中 的 旋转 轴 。w 是 标量 ， 表 示 旋 转角 
度 。 那 么 就 是 绕 轴 旋转 w 度 ， 所 以 一 个 四 元 数 可 以 表示 一 个 完整 的 旋转 。 只 有 单位 四 元 数 才 可 
以 表示 旋转 ， 至 于 为 什么 ， 因 为 这 束 是 四 元 数 表示 族 转 的 约束 条 件 。 


而 刚才 用 欧 拉 和 角 摘 述 的 方向 余弦 算 阵 用 四 元 数 掺 述 则 为 : 


| 


qi +9 229994) 2(9.9;+q00) 
Ce =| A ts) + 2 90) 
G93—909) 2993 +9) -qq +g 


所 以 在 软件 解 算 中 ， 我 们 要 首先 把 加 速度 计 采 集 到 的 值 (三 维 向 量 ) 转 化 为 单位 向 量 , 即 向 量 除 
以 模 ， 传 入 参数 是 陀螺 仪 x,y,z 值 和 加 速度 计 x,y,z 值 : 


vold IMUupdate(float gx, float gy, float gz, float ax, float ay, float az) { 
float norm; 

float vx, Vy, V2; 

float ex, ey, ez2z; 


norm = sqrt(ax*ax + ay*ay + az*az); 


ax = ax / Norm; 
ay = ay / nNorm; 
az = az / nNorm; 


下 面 把 四 元 数 换算 成 方向 余弦 中 的 第 三 行 的 三 个 元 素 。 刚 好 vx,vyVvz 其 实 就 是 上 一 次 的 欧 拉 角 
(四 元 数 ) 的 机 体 坐 标 参考 系 换算 出 来 的 重力 的 单位 向 量 。 


// estimated direction of gravity 


vx = 2 (9q1 93 - 9q9 9q2) 
Vy = 2 90 q1 + 9q2 9q3) 
Vz = 9q0*q0 - d1*q1 - 9q2*q2 + gq3*q3; 


axXyZz 是 机 体 坐 标 参 照 系 上 ， 加 速度 计 测 出 来 的 重力 向 量 ， 也 融 是 实际 测 出 来 的 重力 向 量 。 


axyz 是 测量 得 到 的 重力 同 量 ，Vvxyz 是 陀螺 积分 后 的 容 态 来 推算 出 的 重力 同 量 ， 它 们 都 是 机 体 
坐标 参照 系 上 的 重力 向 量 。 


那 它们 之 间 的 误 震 同 量 ， 融 是 陀螺 积分 后 的 姿态 和 加 计 测 出 来 的 姿态 之 间 的 误 天 。 


向 量 间 的 误差 ， 可 以 用 向 量 叉 积 (也 叫 向 量 外 积 、 叉 乘 ) 来 表示 ，exyz 丈 是 两 个 重力 向 量 的 
义 积 。 


这 个 叉 积 同 量 仍旧 是 位 于 机 体 坐 标 系 上 的 ， 而 陀螺 积分 误 震 也 是 在 机 体 坐 标 系 ， 而 且 又 积 的 
大 小 与 陀螺 积分 误 震 成 正比 ， 正 好 拿 来 纠正 陀螺 。 (你 可 以 目 己 拿 东 西 想象 一 下 ) 由 于 陀螺 
是 对 机 体 直 接 积 分 ， 所 以 对 陀螺 的 纠正 量 会 直接 体现 在 对 机 体 坐 标 系 的 纠正 。 


// integral error Scaled integral gain 
exInt = exInt + ex*Ki; 
eyInt = eyInt + ey*Ki; 


ezInt ezInt + ez*Ki; 


用 又 积 误 直 来 做 PI 修 正 陀螺 圭 偏 


// integral error Scaled integral gain 

exInt = exInt + ex*Ki; 

eyInt = eyInt + ey*Ki; 

ezInt = ezInt + ez*Ki; 

// adjusted gyroscope measurements 
= gx + Kp*ex + exInt; 

gy = gy + Kp’*ey + eyInt, 
= gz + Kp*ez + ezInt; 


四 元 效 微分 方程 ， 其 中 T 为 测量 周期 ， 为 陀螺 仪 角速度 ， 以 下 都 是 已 知 量 ， 这 里 使 用 了 一 阶 龙 
哥 库 塔 求解 四 元 数 微分 方程 : 


O— Yaz -ey OO YYIZ1 Se > 办 一 系 ) 了 2Z2 RIM OO Tp, 


cosy 0 —siny|l 0 0 1cosw 一 Sm 办 0 
C =CoCC =|0O 1 0 |0 woo singllsing cosw 1 
sny 0 cosy 10 -sing cos@| 0 0 ] 


cOS7YCcOSW + SIN YSINWSINO —cosysinw+snycoswsinod —sinycoso 
二 shy coso COSU/COSO sl 总 


sn ycosWw 一 COSYSIWwSIB —sinysinw—cosycoswsind cosycoso 


// integrate quaternion rate and normalise 
q9 = gO + (-gqi*gx - q2*gy - gq3*gz)*halfT,; 
qi = qi + (qo*gx + gq2*gz - q3*gy)*halfT; 
q2 = gq2 + (gqO*gy - di’*gz + q3*gx)*halfT; 
q3 = gq3 + (q0*gz + gi*gy - q2*gx)*halfT; 


最 后 根据 四 元 数 方向 余弦 阵 和 了 欧 拉 角 的 转换 天 系 ， 把 四 元 数 转 换 成 欧 拉 角 : 


O— Tn YZ) 2 


cosy 0 —siny|l 0 0 1cosw 一 Sm 办 0 
C=OCC=| 0 1 0 |10 cosg sing| sing cosw 0 
sny 0 cosy 一 SO cos@ll 0 0 ] 


COSY COSUW + SIN YSINWSINGO 一 cOS7YSIIWTSI 7YCcosSWwSID —sinycoso 
= shy coso COSIUW COSO sn 


sn Yeosw—cosysinwsingd —sinysinw—cosycoswsind cosycoso 


所 以 有 : 


Q_ ANGLE .Yaw = atan2(2 * q1 * gq2+2*0gq0* gq3, -2* gq2*q2 -2* 093* gq3+ 1)* 57.3; // yaw 
0Q ANGLE.Y = asln(=2 “91 03+2 ”00 qoq2)* 57.3; /7 pitceh 
Q ANGLE.X = atan2(2 * 9q2*q3+2*090*3gqi, -2*91*qi-2* 9q2* qdq2 + 1)* 57.3; // rol 





使 件 安 态 解 算 


作者 : 路 洋 














四 轴 的 姿态 解 算 无 疑 是 最 繁琐 的 步骤 没有 之 一 ， 但 是 目 从 MPU6050 出 现 了 硬件 DMP 的 时 候 ， 
大 妈 都 能 完成 姿态 解 算 了 | 


CrazePony 使 用 了 MPU6050 目 带 的 硬件 四 元 数 单 元 ， 可 以 通过 lIC 和 直接 读 取 四 元 数 ， 省 却 了 软 
件 解 算 楷 琐 的 算法 步骤 ， 非 章 方 便 易 用 。 


这 里 还 是 要 首先 介绍 下 四 元 数 ， 四 元 数 要 说 的 实在 太 多 ， 因 为 它 的 优点 很 多 ， 利 用 起 来 很 方 
便 ， 但 是 理解 起 来 束 有 点 疝 脚 了 。 我 们 百度 四 元 数 ， 一 开始 看 到 的 束 是 四 元 数 来 历 ， 还 有 区 
是 四 元 数 的 基本 计算 。 对 于 来 历 ， 还 是 想 说 一 下 ， 四 元 数 (Quaternions) 是 由 威廉 : 卢 云 : 哈 
密 尔 顿 (William RowanHamilton,1805-1865) 在 1843 年 爱尔兰 发 现 的 数学 概念 。 


将 实数 域 扩 充 到 复数 域 ， 并 用 复数 来 表示 平面 向 量 ， 用 复数 的 加 、 乘 运算 表示 平面 向 量 的 合 
成 、 伸 缩 和 旋 ， 这 残 是 我 们 熟知 的 复数 的 二 维 空间 含义 ， 所 以 人 们 会 继续 和 猜想， 利用 三 维 复 
数 不 就 可 以 表达 三 维 空间 的 变换 了 吗 ， 历 史上 有 很 多 数学 家 试图 寻找 过 三 维 的 复数 ， 但 后 来 
证 明 这 样 的 三 维 复数 是 不 存在 的 。 有 关 这 个 结论 的 证 明 ， 我 没有 查 到 更 明确 的 版 本 ， 据 《上 古 
今 数 学 思想 》 中 的 一 个 理由 ， 三 维 空间 中 的 伸缩 旋转 变换 需要 四 个 变量 来 决定 : 两 个 变量 决 
定 轴 的 方向 ， 一 个 变量 决定 旋转 角度 ， 一 个 变量 决定 伸缩 比例 。 这 样 ， 只 有 三 个 变量 的 三 维 
复数 无 法 满足 这 样 的 要 求 。 但 是 万 史上 得 到 的 应 该 是 比 这 个 更 强 的 结论 ， 即 使 不 考虑 空间 旅 
转 ， 只 从 代数 角度 来 说 ， 三 维 的 复数 域 作 为 普通 复数 域 的 扩张 域 是 不 存在 的 。 并 且 ， 据 《 古 
今 数 学 思想 》 和 叙述 ， 即 使 像 哈密 和 尔 顿 后 来 引入 四 元 数 那样 ， 牺 牲 乘 法 交换 律 ， 这 样 的 三 维 复 
数 也 得 不 到 。 经 过 一 些 年 的 努力 之 后 ， Hamilton 发 现 自己 被 迫 应 作 两 个 让 步 ， 第 一 个 是 他 的 
新 数 包含 四 个 分 量 ， 而 第 二 个 是 他 必须 牺牲 乘法 交换 律 。 ( 《古今 数学 思想 》 第 三 册 177 
页 ) 但 是 四 元 数 用 作 旋 转 的 作用 明显 ， 简 化 了 运算 ， 而 且 避 免 了 Gimbal Lock， 四 元 数 是 最 简 
单 的 超 复数 ， 我 们 不 能 把 四 元 数 简单 的 理解 为 3D 空间 的 矢量 ， 它 是 4 维 空间 中 的 的 矢量 ， 也 
是 非常 不 容易 想像 的 。 

我 们 知道 在 平面 (x,y) 中 的 旋转 可 以 用 复数 来 表示 ， 同 样 的 三 维 中 的 旋转 可 以 用 单位 四 元 效 来 
描述 。 我 们 来 定义 一 个 四 元 数 : 


- 


qd=a+ 2 =go+qi+q2j+gqk 


我 们 可 以 把 它 写成 [w,V]， 其 中 V= i+q2j+q 沙 ，w=a = qo、 那么 V 是 矢量 ， 表 示 三 
维 空间 中 的 旋转 轴 。w 是 标量 ， 表 示 旋 转角 度 。 那 么 [W, Vj 就 是 绕 轴 V 旋 转 w 度 ， 所 以 一 个 四 
元 数 可 以 表示 一 个 完整 的 旋转 。 只 有 单位 四 元 数 寺 可 以 表示 旋转 ， 至 于 为 什么 ， 因 为 这 就 是 
四 元 数 表示 旋转 的 约束 条 件 。 


所 以 大 家 可 以 理解 为 ， 单 位 四 元 数 能 够 表示 旋转 。 我 们 给 出 一 组 单位 四 元 数 和 欧 拉 角 的 转换 
天 系 ， 通 过 这 个 关系 来 将 采集 到 的 四 元 数 转化 成 欧 拉 角 ， 原 理 将 在 软件 解 算 中 给 出 ， 这 里 让 
接 使 用 融 可 以 了 : 


0=—sin™ 2*(q1g2- go0g3) 
el 2(9192+ Go0g3) 


有 二 人 es er 
tdo—d 0 
有 2(g We + do) 


q; +q97—g + 
所 以 在 四 轴 飞 行 器 中 ， 传 感 器 读 取 到 四 元 数 ， 首 先 应 先 将 它 吨 一 化 成 单位 四 元 数 : 


norm = dmpinvSqrt(q[0]*q[0] + q[1i]*q[l1i] + ql2]*q[2] + ql3]*q9q[3]); 
q[0] = q[0] * norm; 
q[1] = q[1] * norm; 
q[2] = q[2] * norm; 
q[3] = q[3] * norm; 


为 一 化 后 根据 四 元 数 和 欧 拉 角 转 换 公式 把 四 元 数 转 化 为 欧 拉 角 ，OK ,硬件 姿 态 解 算 完成 ! 


DMP_DATA.dmp_roll = (atan2(2.0*(q[0]*q[1] + 9q[2]1*9[3]), 1 - 2.0*(gq[1]*q[1i] + q[2]*9q[2]))) 
// we let safe asin() handle the singularities near 90/-90 in pitch 
DMP_DATA.dmp_pitch = dmpsafe asin(2.0*(gq[0]*9q[2] - q[3]*9[1]))* 180/M_PI; 


DMP_DATA.dmp_yaw = -atan2(2.0*(gq[0]*9q[3] + 9[1]*q[2]), 1 - 2.0*(gq[2]*9[2] + gq[3]*9[3]))* 
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四 元 数 与 四 轴 飞 行 絮 

作者 : nieyong 
四 元 效 
四 元 数 是 由 爱尔兰 数学 家 威廉 卢 云 :哈密 屯 在 1843 年 发 现 的 数学 概念 。 从 明确 地 和 角度 而 言 ， 四 
元 数 是 复数 的 不 可 交换 延伸 。 如 把 四 元 数 的 集合 考虑 成 多 维 实数 空间 的 话 ， 四 元 数 束 代 表 看 
一 个 四 维 空间 ， 相 对 于 复数 为 二 维 空间 。 
四 元 数 大 量 用 于 电脑 绘图 (及 相关 的 图 像 分 析 ) 上 表示 三 维 物 件 的 旋转 及 方位 。 四 元 数 亦 见 

于 控制 论 、 信 号 处 理 、 姿 态 控制 、 物 理 和 轨道 力学 ， 都 是 用 来 表示 旋转 和 方位 。 


相对 于 另 几 种 旋转 表示 法 《起 阵 ， 欧 拉 角 ， 轴 角 ) ， 四 元 数 具有 某 些 方面 的 优势 ， 如 速度 更 
快 、 提 供 平滑 插值 、 有 效 如 免 万 向 锁 问 题 、 存 储 空间 较 小 等 等 。 


以 上 部 分 摘 目 维基 百科 -四 元 数 。 


安 态 解 算 为 什么 要 用 四 元 效 


姿态 解 算 的 核心 在 于 旋转 ， 一 般 旋 转 有 4 种 表示 方式 : 息 阵 表示 、 了 欧 拉 角 表 示 、 轴 角 委 示 和 四 
元 数 表示 。 和 矩阵 表示 适合 变换 同 量 ， 欧 拉 角 最 直观， 轴 和 骨 表 示 则 适合 几何 推导 ， 而 在 组 合 旋 
转 方面 ， 四 元 数 表示 最 佳 。 因 为 姿态 解 算 需要 频繁 组 合 旋转 和 用 旋转 变换 向 量 ， 所 以 采用 四 
元 数 你 存 组 合 姿态 、 辅 以 答 阵 来 变换 疝 量 的 方 宁 。 


总 结 来 说 ， 在 crazepony 中 ， 姿 态 解 算 中 使 用 四 元 数 来 保存 飞行 器 的 姿态 ， 包 括 旋 转 和 方位 。 
在 获得 导 四 元 数 之 后 ， 会 料 其 转化 为 欧 拉 角 ， 然 后 输入 到 姿态 控制 算法 中 。 


姿态 控制 算法 的 输入 参数 必须 要 是 欧 拉 角 。AD 值 是 指 MPU6050 的 陀螺 仪 和 加 速度 值 ，3 个 维 
大 的 陀螺 仪 值 和 3 个 维度 的 加 速度 值 ， 每 个 值 为 16 位 精度 。AD 值 必须 先 转化 为 四 元 数 ， 然 后 
通过 四 元 数 转 化 为 欧 拉 角 。 这 个 四 元 数 可 能 是 软 解 ， 主 控 心 片 (STM32) 读 取 到 AD 值 ， 用 软 
件 从 AD 值 算 得 ， 也 可 能 是 通过 MPU6050 中 的 DMP 硬 解 ， 主 控 芯 片 (STM32) 直接 读 取 到 四 
元 数 。 具 体 参 考 《MPU60x0 的 四 元 数 生成 方式 介绍 》。 


下 面 束 是 四 元 数 软 解 过 程 ， 可 以 由 下 面 这 个 框图 表示 : 
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MPU6050 


400kHz 的 12C 接口 





四 元 数 的 运算 

下 面 介 绍 一 下 四 元 数 ， 然 后 给 出 几 种 旋转 表示 的 转换 。 这 些 运算 在 crazepony 的 代码 中 都 会 
全 | 。 

四 元 数 可 以 理解 为 一 个 实数 和 一 个 向 量 的 组 合 ， 也 可 以 理解 为 四 维 的 向 量 。 这 里 用 一 个 圈 表 
示 gq 是 一 个 四 元 数 (很 可 能 不 是 规范 的 表示 方式 ) 。 

本 一 上 T 

4=IW,VvI=Iw x y 过 


四 元 数 的 长 度 ( 模 ) 与 普通 向 量 相 似 。 





A 2 2 2 
W +X 十 yy 二 之 
下 面 是 对 四 元 数 的 单位 化 ， 单 位 化 的 四 元 数 可 以 表示 一 个 旋转 。 








WwW 上 
gd Iq| 


四 元 数 相 乘 ， 施 转 的 组 合 束 靠 它 了 。 
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d 0 一 4d1d4 > 
WW Any Sy 
| Xo 二 Wi1X2 十 X1W2 二 Vi1Z2 一 2 yY2 
yo 三 Wi1yV2 一 X1Z2? 十 V1W2 十 之 1X? 
之 0 二 W1Z2? 十 X1V2 一 V1X2 十 之 W, 
旋转 的 “ 轴 角 表示 " 转 “ 四 元 数 表示 "。 这 里 创造 一 个 运算 q(w,9)， 用 于 把 绕 单位 向 量 w 转 9 角 的 族 
转 表示 为 四 元 数 。 
ee 村 时 aa 
lw,6I 一 dl(w,0)=lcos( 二 ) ,WwWw:Ssin( 二 )| 
了 2 

通过 q(w 6)， 引 伟 出 一 个 更 方便 的 运算 q(f ti。 有 时 需要 把 向 量 f 的 方向 转 到 向 量 t 的 方向 
运算 就 是 生成 表示 对 点 旋转 的 四 元 数 的 (后 面 会 用 到 ) 


a(F ,= (Lt ,atan2(fxil, FE)) 
天 > 


然后 是 "四 元 效 表 示 " 转 "和 炬 阵 表 示 "。 再 
到 ) 。 


次 创造 运算 ， 用 R(q) 和 表示 四 元 数 q 对 应 的 算 阵 《后 面 用 


1-2yY-2z” 2xy-2wz 2xz+2wy 
” 2VZz-2WX 


4 一 及 (9g)=| 2xy+2wz 1-2x“ 一 2z 
2xz-2wVy 2yz+2wx 1-2x°-2y 


多 个 旋转 的 组 合 可 以 用 四 元 数 的 乘法 来 实现 。 
RIG) Rdi)= 及 (di 9 


“四 元 数 表示 ” 转 “ 欧 拉 角 表示 ”。 用 于 显示 。 


4 一 [9.0p| 
一 22 
0=arcsin(2wy—2zxX) 
ed i 
: 偏 航 角 (yaw),z 轴 
: 俯仰 角 (pitch),y 轴 
: 滚 转 角 (roll),x 轴 
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也 虹 仪 


陀螺 仪 ， 测 量 角 速度 ， 具 有 高 动态 特性 ， 但 是 


它 是 一 个 间接 测量 角度 的 器 件 ， 它 测量 的 是 角 
度 的 导数 ， 和 角速度， 要 将 角速度 对 时 间 积 分 才能 得 


到 和 角度。 


如 果 这 个 世界 是 理想 的 ， 美 好 的 ， 那 我 们 的 问题 到 此 残 解 决 了 ， 不 过 很 让 憾 ， 现 实 是 残酷 
的 ， 误 下 的 引入 ， 使 得 积分 出 现 了 问题 。 


假设 陀螺 仪 固 定 不 动 ， 理 想 角 速度 值 是 0dps(degree per second)， 但 是 有 一 个 偏 置 0.1dps 加 
在 上 面 ， 于 是 测量 出 来 是 0.1dps， 积 分 一 秒 之 后 ， 得 到 的 角度 是 0.1 度 ，1 分 钟 之 后 是 6 度 ， 还 
能 忍受 ， 一 小 时 之 后 是 360 度 ， 转 了 一 图， 也 就 是 说 ， 陀 曙 仪 在 短 时 间 内 有 很 大 的 参考 价值 。 


陀螺 仪 就 是 内 部 有 一 个 陀螺 ， 它 的 轴 由 于 陀螺 效应 始终 与 初始 方向 平行 ， 这 样 就 可 以 通过 与 
初始 方向 的 偏差 计算 出 实际 方向 。 传 感 器 MPU6050 实 际 上 是 一 个 结构 非常 精密 的 芯片 ， 内 部 
包含 超 微小 的 陀螺 。 陀 螺 仪 运转 一 段 时 间 以 后 ，noise 和 offset 会 导致 数据 偏差 ， 需 要 借助 其 它 
传感器 进行 较 正 。 


使 用 陀螺 仪 获 得 角度 ， 一 定 要 考虑 积分 误 焉 的 问题 。 


加 速度 计 


加 速度 计 可 以 测量 加 速度 ,包括 重力 加 速度 ,于 是 在 静止 或 匀速 运动 的 时 候 , 加 速度 计 仅仅 测量 的 
是 重力 加 速度 ,而 重力 加 速度 与 刚才 所 说 的 R 坐 标 系 是 固 连 的 ,通过 这 种 关系 ,可 以 得 到 加 速度 计 
所 在 平面 与 地 面 的 角度 关系 . 


但 是 加 速度 计 和 石 是 绕 厦 重力 加 速度 的 轴 转 动 , 则 测量 值 不 会 改变 ,也 融 是 说 无 法 感知 这 种 水 平 放 
转 。 


天 于 MPU6050 


MPU-60x0 是 全 球 首 例 9 轴 运 动 处 理 传 感 器 。 它 集成 了 3 轴 MEMS 陀 螺 仪 ，3 轴 MEMS 加 速度 
计 ， 以 及 一 个 可 扩展 的 数字 运动 处 理 器 DMP (Digital Motion Processor) ， 可 用 Il2C 接 口 连接 
一 个 第 三 方 的 数字 传 感 妖 ， 上 比如 磁力 计 。 扩 展 之 后 就 可 以 通过 其 |2C 或 SPI 接 口 输出 一 个 9 轴 的 
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信号 (SPI 接 口 仅 在 MPU-6000 可 用 ) 。MPU-60x0 也 可 以 通过 其 12C 接 口 连接 非 惯 性 的 数字 传 
感 器 ， 比 如 压力 传感器 。 


MPU-60x0 对 陀螺 仪 和 加 速度 计 分 别 用 了 三 个 16 位 的 ADC， 将 其 测量 的 模拟 量 转化 为 可 输出 
的 效 字 量 。 为 了 精确 跟 蹊 快速 和 慢 速 的 运动 ， 传 感 器 的 测量 范围 都 是 用 户 可 控 的 ， 陀 螺 仪 可 
测 范 围 为 +250，+500，+1000，+2000"/ 秒 (dps) ， 加 速度 计 可 测 范 围 为 
+2，+4，+8，+16g。 一 个 片上 1024 字 节 的 FIFO， 有 助 于 降低 系统 功 耗 。 和 所 有 设备 寄存 器 
之 间 的 通信 采用 400kHz 的 |2C 接 口 或 1MHz 的 SPI 接 口 (SPI 信 MPU-6000 可 用 ) 。 对 于 需要 高 
速 传输 的 应 用 ， 对 寄存 器 的 读 取 和 中 断 可 用 20MHz 的 SPI。 另外 ， 片 上 还 内 艇 了 一 个 温度 传 感 
器 和 在 工作 环境 下 仅 有 +1% 变动 的 振荡 器 。 


在 crazepony 上 ，MPU6050,HMC5883 传 感 器 之 间 的 连接 如 下 图 所 示 。 


3 轴 [ 它 螺 仪 
9 轴 数 据 ; 3 轴 加 速度 
3 轴 磁 力 计 


3 轴 磁 力 计数 据 





3 轴 磁 力 计 3 轴 队 螺 仪 3 轴 主 控 MCU 
加 速度 计 
MPU6050 中 DMP 总 用 


在 Crazepony-ll 上 ， 测 试 了 软件 解 算 四 元 素 ， 然 后 通过 四 元 素 解 算 姿 态 角 这 种 实现 方式 ， 其 实 
总 的 来 说 ， 并 没 感觉 36MHz 的 主 控 压力 有 和 多大， 没有 出 现 机 号 不 稳 ， 卡 死 的 情况 。 


MPU6050 


16 位 ADC 值 


400kHz 的 12C 接口 
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同时 ， 本 着 务实 他 的 态度 ， 我 们 也 测试 了 MPU6050 的 硬 解 四 元 素 ， 即 从 IIC 总 线 上 读 到 的 数据 
不 再 是 MPU60x0 的 AD 值 ， 而 是 通过 初始 化 对 DMP 引 擎 的 配置 ， 从 IIC 总 线 上 读 到 的 直接 就 是 
四 元 素 的 值 ， 从 而 跳 过 了 程 序 通过 AD 值 计 算 四 元 素 这 个 看 起 来 繁琐 的 步骤 。 测 试 结果 是 ， 机 
身 反 应 的 确 要 比 之 前 反应 灵活 ， 最 关键 的 一 点 是 ， 这 样 得 出 的 偏 航 角 (Yaw) 很 稳 很 稳 ， 基 本 
不 会 漂移 或 者 说 漂移 小 到 了 可 以 容忍 的 地 步 。 


最 后 ，MPU60x0 的 强大 之 处 不 仅 于 此 ， 它 支持 一 个 从 lIC 接 口 ， 可 以 外 部 接 上 一 个 磁力 计 ， 如 
HMC5883， 这 样 一 来 ，DMP 引 擎 可 以 直接 输出 一 个 绝对 的 方向 安 态 ， 即 能 够 输出 一 个 带 东 西 
南北 的 姿态 数据 包 ， 很 厉害 的 样子 。 在 Crazepony-ll 第 四 版 将 会 加 上 这 样 一 个 磁力 计 ， 相 信 它 
再 也 不 会 迷路 了 ~~ 


MPU6050 


400kHz 的 12C 接口 
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四 轴 PID 控 制 算 法 


作者 : nieyong 


四 轴 控 制 原理 


四 轴 飞 行 句 的 螺旋 桨 与 空气 发 生 相 对 运动 ， 产 生 了 同上 的 升力 ， 当 升力 大 于 四 轴 的 重力 时 四 
轴 融 可 以 起 飞 了 。 

四 轴 飞 行 嚣 飞行 过 程 中 如 何 保持 水 平 呢 ? 

我 们 先 假设 一 种 理想 状况 ， 四 个 电机 的 转速 是 完全 相同 的 ， 是 不 是 我 们 控制 四 轴 飞 行 器 的 四 
个 电机 保持 同样 的 转速 ， 当 转速 超过 一 个 临界 点 时 (升力 刚好 抵消 重力 ) 四 轴 融 可 以 平稳 的 
飞 起 来 了 呢 ? 

答案 是 否定 的 ， 由 于 四 个 电机 转 同 相同 ， 四 轴 会 发 生 旋 转 。 我 们 控制 四 轴 电 机 1 和 电机 3 同 同 


( 逆 时 针 旋 转 ) ， 电 机 2 电机 4 反 向 ( 顺 时 针 旋 转 ) ， 刚 好 正 反 扭 矩 抵消 ， 巧 妙 的 实现 了 平 
衡 ， 如 下 图 所 示 。 





实际 上 由 于 电机 和 螺旋 奖 本 身 制 造 的 舌 异 我 们 无 法 做 到 四 个 电机 转速 完全 相同 ， 很 有 可 能 飞 
行 器 起 飞 之 后 就 侧 翻 。 这 时 候 大 家 可 能 会 想到 要 用 遥控 器 来 控制 电机 ， 我 们 来 党 试 一 下 下 面 
向 右 侧 翻 的 情况 。 





[ 广 向 右 刘 翻 


由 于 电机 的 不 平衡 ， 在 人 眼 的 观察 下 发 现 飞机 向 右 侧 翻 ， 我 们 控制 右 侧 电机 1 电机 2 提高 转速 
增加 升力 ， 飞 机 兴 于 平衡 。 由 于 飞机 是 一 个 动态 系统 ， 在 接 下 来 我 们 会 一 直 重 复 : 观察 -> 大 
脑 计 算 -> 控制 -> 观察 -> 大 脑 计 算 -> 控 制 。 





保持 ”| 控制 算法 | | 执行 机 构 | | 控制 对 象 | 四 轴 的 


控制 | 下 稀 下 稀 
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状态 现 , 测 


但 事实 上 这 是 不 可 能 的 ， 因 为 人 无 法 长 时 间 精 确 的 同时 控制 四 个 电机 。 我 们 需要 一 个 目 动 反 
馈 系统 蔡 代 人 操作 来 完成 飞机 的 上 自 稳 定 ， 我 们 人 只 需要 控制 飞机 的 方向 和 高 度 束 可 以 了 。 这 
个 系统 中 反馈 由 姿态 传感器 蔡 代 眼睛 ， 而 大 脑 则 由 单片机 来 蔡 代 。 这 时 候 访 PID 控制 系统 出 
场 。 


PID 控 制 理论 


PID 控 制 是 最 常见 ， 上 应 用 最 为 广泛 的 自动 反馈 系统 。PID 控 制 器 由 偏差 的 比例 (P， 
Proportional) 、 积 分 (I|，|Integral) 和 微分 (D，Derivative) 来 对 被 控 对 象 进行 控 制 。 这 里 
的 积分 或 微分 ， 都 是 偏差 对 时 间 的 积分 或 微分 。 














对 于 一 个 目 动 反馈 控制 系统 来 说 ， 有 几 个 基本 的 指标 。 


。 稳定 性 (P 和 | 降低 系统 稳定 性 ，D 提 高 系统 稳定 性 ) : 在 平衡 状态 下 ， 系 统 受到 菏 个 干扰 
后 ， 经 过 一 段 时 间 其 被 控 量 可 以 达到 某 一 稳定 状态 ; 

。 准确 性 〈P 和 | 提高 稳 态 精度 ，D 无 作用 ) : 系统 处 于 稳 态 时 ， 其 稳 态 误差 (Steady-state 
error) 

。 快速 性 (P 和 DD 提高 响应 速度 ，| 降 低 响 应 速度 ) : 系统 对 动态 响应 的 要 求 。 一 般 由 过 渡 时 
间 的 长 短 来 衡量 。 


比例 (P) 控制 


比例 控制 是 一 种 最 简单 的 控制 方式 。 其 控制 器 的 输出 与 输入 误差 信号 成 比例 关系 。 当 仅 有 上 比 
例 控制 时 系统 输出 存在 稳 态 误差 。 比 例 项 输出 : 

Put = K, elt) 

积分 (|) 控制 

在 积分 控制 中 ， 控 制 器 的 输出 与 输入 误差 信号 的 积分 成 正比 关系 。 对 于 只 有 上 比例 控制 的 系统 
存在 稳 态 误差 ， 为 了 消除 稳 态 误差 ， 在 控制 器 中 必须 引入 “积分 项 "。 积 分 项 是 误差 对 时 间 的 积 
分 ， 随 着 时 间 的 增加 ， 积 分 项 会 增 大 。 这 样 ， 即 便 误差 很 小 ， 积 分 项 也 会 随 着 时 间 的 增加 而 
加 大 ， 它 推动 控制 器 的 输出 增 大 使 稳 态 误差 进一步 减 小 ， 直 到 等 于 零 。 因 此 ， 比 例 积分 (PI) 控 
制 器 ， 可 以 使 系统 在 进入 稳 态 后 无 稳 坊 误差 。 积分 项 输出 : 


nt 
Tut 一 K: | e{T) dT 

0 
微分 (D) 控制 
在 微分 控制 中 ， 控 制 器 的 输出 与 输入 误差 信号 的 微分 成 正比 关系 。 微 分 调节 就 是 偏差 值 的 变 
化 率 。 使 用 微分 调节 能 够 实现 系统 的 超前 控制 。 如 果 输 入 偏差 值 线性 变化 ， 则 在 调节 器 输出 


侧 登 加 一 个 恒定 的 调节 量 。 大 邵 分 控制 系统 不 需要 调节 微分 时 间 。 因 为 只 有 时 间 湛 后 的 系统 
才 需 要 附加 这 个 参数 。 微 分 项 输出 : 


rt 
ult) = MV(t) = Kyelt) + KF: | E{T) dT 十 Ka el 


更 多 天 于 PID 控 制 理论 知识 ， 可 以 参考 维基 百科 PID 控 制 。 


四 轴 PID 控 制 - 单 环 


在 Crazepony 四 轴 飞 行 器 5.0 版 本 及 以 前 ， 我 们 使 用 的 是 单 环 增 量 式 PD 控制 ， 下 面 是 角度 单 环 
PID 控 制 框 图 。 这 里 对 图 中 几 个 数据 进行 说 明 ， 期 望 角度 就 是 御 控 器 控制 飞行 器 的 角度 值 ， 反 
馈 当 前 角度 就 是 传感器 测 得 的 飞行 器 和 角度， 这 里 的 角度 指 的 是 Roll/Pitch/Yaw 三 个 角度 ， 而 且 
在 PID 控 制 计算 的 时 候 ， 是 相互 独立 的 。 





反馈 /当前 角度 
角度 单 环 PIT 原理 杠 图 


以 ROLL 方向 角 展 控制 为 例 : 


。 测 得 ROLL 轴 向 偏差 : 


偏差 = 目标 期 望 角度 -传感器 实测 角度 
DIF_ANGLE.X = EXP_ANGLE.X - Q ANGLE.Ro11; 


。 比例 项 的 计算 : 


比例 项 输出 = 上 比例 系数 P * 偏差 
Proportion = PID Motor.P * DIF_ ANGLE.X; 


。 微分 项 计算 : 由 于 陀螺 仪 测 得 的 是 ROLL 轴 回 施 转 角 速 率 ， 角 速率 积分 融 是 角度 ， 那 么 角 
上 度 微分 即 角 速 率 ， 所 以 微分 量 刚 好 是 陀螺 仪 测 得 的 值 。 


微分 输出 = 微分 系数 D* 角 速率 
DifferentialCoefficient = PID Motor.D ”DMP_DATA.GYROX ， 


ROLL 方 向 总 控制 量 = 比 例 项 输出 + 微分 量 输出 


ROLL 和 PITCH 轴 按照 以 上 公式 计算 PID 输 出 ， 但 YAW 轴 比较 特殊 ， 因 为 偏 航 角 法 线 方 向 刚好 
和 地 球 重力 平行 ， 这 个 方向 的 角度 无 法 由 加 速度 计 直 接 测 得 ， 需 要 增加 一 个 电子 罗盘 来 替代 
加 速度 计 。 如 果 不 使 用 罗盘 的 话 ， 我 们 可 以 单纯 的 通过 角速度 积分 来 测 得 偏 航 角 ， 缺 点 是 由 
于 积分 环节 中 存在 积分 漂移 ， 偏 航 角 随 关 时 间 的 推移 会 偏差 越 来 越 大 ， 就 会 出 现 航向 角 漂 移 
的 问题 。 我 们 不 使 用 罗盘 就 没有 上 比例 项 ， 只 仅 使 用 微分 环节 来 控制 。 
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角速度 积分 党 移 现象 


e YAW 轴 输出 : 


微分 输出 = 微分 系数 D* 角 速率 


YAW 方 向 控制 量 = PID_YAW.D * DMP_DATA .GYROZz; 


四 轴 PID 控 制 - 串 级 


角度 单 环 PID 控 制 算 法 仅仅 考虑 了 飞行 器 的 角度 信息 ， 如 果 想 增加 飞行 器 的 稳定 性 (增加 阻尼 ) 
并 提高 它 的 控制 品质 ， 我 们 可 以 进一步 的 控制 它 的 角速度 ， 于 是 角度 /和 角速度 - 串 级 PID 控 制 算 
法 应运 而 生 。 在 这 里 ， 相 信 大 多 数 朋 友 已 经 初步 了 解 了 角度 单 环 PID 的 原理 ， 但 是 依旧 无 法 理 
解 串 级 PID 究 竟 有 什么 不 同 。 其 实 很 简单 : 它 融 是 两 个 PID 控 制 算法 ， 只 不 过 把 他 们 串 起 来 了 
(更 精确 的 说 是 套 起 来 )。 那 这 么 做 有 什么 用 ? 党 案 是 ， 它 增强 了 系统 的 抗 干扰 性 (也 束 是 增强 稳 
定性 )， 因 为 有 两 个 控制 器 控制 飞行 句 ， 它 会 比 单个 控制 器 控制 更 多 的 变量 ， 使 得 飞行 器 的 适 
应 能 力 更 强 。 为 了 更 为 清晰 的 讲解 串 级 PID， 这 里 笔者 依旧 画 出 串 级 PID 的 原理 框图 ， 如 图 所 
/小 ， 










期 望 角速度 
角度 环 PID | (角度 环 pp 输出 ) | 角速度 环 


控制 器 PID 控 制 怖 








Ne 


反馈 /当前 角度 
角度 /和 角速度 - 串 级 PID 原 理 框 图 


Crazepony 在 5.1 版 本 及 以 后 ， 就 是 采用 角度 /角速度 串 级 PID 控 制 。 详 见 control.c 文件 中 
的 ctrlAttiAng(void) 图 数 和 ctrlAttiRate(void) 图 数 。 


如 何 整定 串 级 PID 时 的 经 验 ， 来 自 CSDN 网 友 Nemo 之 家 博客 四 轴 PID 讲 解 。 原 则 是 先 整定 内 环 
PID， 骨 整定 外 环 P。 


e。 内 环 P : 从 小 到 大 ， 拉 动 四 轴 越 来 越 困 难 ， 越 来 越 感觉 到 四 轴 在 抵抗 你 的 拉动 ; 到 比较 大 
的 数值 时 ， 四 轴 目 己 会 高 频 震 动 ， 肉 眼 可 见 ， 此 时 拉扯 它 ， 它 会 快速 的 振荡 几 下 ， 过 几 
秒 钟 后 稳定 ; 继续 增 大 ， 不 用 加 人 为 干扰 ， 自 己 发 散 番 机。 特别 注意 : 只 有 内 环 忆 的 时 
候 ， 四 轴 会 缓慢 的 往 一 个 方向 下 掉 ， 这 属于 正常 现象 。 这 束 是 系统 角速度 静 闫 。 

。 内 环 | : 前 述 PID 原 理 可 以 看 出 ， 积 分 只 是 用 来 消除 静 差 ， 因 此 积分 项 系数 个 人 觉得 没 必 
要 弄 的 很 大 ， 因 为 这 样 做 会 降低 系统 稳定 性 。 从 小 到 大 ， 四 轴 会 定 在 一 个 位 置 不 动 ， 不 
再 往 下 挥 ; 继续 增加 | 的 值 ， 四 轴 会 不 稳定 ， 拉 扯 一 下 会 目 己 发 散 。 特 别 注意 : 增加 /的 
值 ， 四 轴 的 定 角度 能 力 很 强 ， 拉 动 他 比较 困难 ， 似 乎 像 是 在 条 生子 一 样 ， 但 是 一 旦 有 强 干 
扰 ， 它 就 会 发 散 。 这 是 由 于 积分 项 太 大 ， 拉 动 一 下 积分 速度 快 ， 给 的 补偿 非常 大 ， 因 此 
很 难 拉动 ， 给 人 一 种 很 稳定 的 错觉 。 

。 内 环 D : 这 里 的 微分 项 D 为 标准 的 PID 原 理 下 的 微分 项 ， 即 本 次 误差 -上 次 误差 。 在 角速度 
环 中 的 微分 就 是 角 加 速度 ， 原 本 四 轴 的 震动 就 比较 强烈 ， 引 起 陀螺 的 值 变化 较 大 ， 此 时 
做 微分 就 更 容易 引入 噪声 。 因 此 一 般 在 这 里 可 以 适当 做 一 些 滑动 滤波 或 者 IIR 滤 波 。 从 小 
到 大 ， 飞 机 的 性 能 没有 多 大 改变 ， 只 是 回 中 的 时 候 更 加 平稳 ; 继续 增加 D 的 值 ， 可 以 肉眼 
看 到 四 轴 在 平衡 位 置 高 频 震 动 (或 者 听 到 电机 发 出 滋 滋 的 声音 )。 前 述 已 经 说 明 D 项 属于 辅 
助 性 项 ， 因 此 如 果 机 架 的 震动 较 大 ，DD 项 可 以 忽略 不 加 。 

。 外 环 P : 当 内 环 PID 全 部 整定 完成 后 ， 飞 机 已 经 可 以 稳定 在 某 一 位 置 而 不 动 了 。 此 时 内 环 
P， 从 小 到 大 ， 可 以 明显 看 到 飞机 从 倾斜 位 置 慢 慢 回 中 ， 用 手 拉扯 它 然 后 放手 ， 它 会 慢 速 
回 中 ， 达 到 平衡 位 置 ; 继续 增 大 P 的 值 ， 用 遥控 器 给 不 同 的 角度 给 定 ， 可 以 看 到 飞机 跟踪 
的 速度 和 响应 越 来 越 快 ; 继续 增加 P 的 值 ， 飞 机 变 得 十 分 敏感 ， 机 动 性 能 越 来 越 强 ， 有 发 
散 的 趋势 。 


电机 的 输出 整合 


油门 控制 Throttle 是 电机 输出 的 基准 值 ， 增 加 油门 即 可 四 轴 升 高 ， 减 小 油门 即 下 降 。 最 后 整合 
上 面 通过 PID 算 得 的 ROLL/PITCH/YAW 三 轴 输 出 量 进 行 电机 控制 。 整 合 如 下 ， 在 control.c 文 
件 的 函数 ctrlMotor() 中 实现 。 


ROW 
Motor3 0 Motor2 
| 
| 
| 





Motord Motorl 


Motor[2|] = (int16 t)(Thr - Pitch - Roll - Yaw ) //M3 
Motor[0] = (int16 t)(Thr + Pitch + Roll - Yaw ); //M1 
Motor[3] = (int16 t)(Thr - Pitch + Roll + Yaw ); //M4 
Motor[1] = (int16 t)(Thr + Pitch - Roll + Yaw ) //M2 


Crazepony 左 下 和 角 为 M1 机 辟 ， 在 代码 中 对 应 电机 为 Motor[6] ， 然 后 道 时 针 依 次 为 M2，M3， 
M4， 如 图 所 示 。 如 果 四 轴 绕 ROLL 轴 向 右倾 斜 5 度 ， 那 么 电机 1 电机 2 应 该 提高 升力 ， 电 机 3 电 
机 0 减 小 升力 恢复 平衡 状态 ， 所 以 有 以 下 规则 : 


。 Roll 方 向 旋转 ， 为 了 恢复 平衡 ， 则 电机 1 电机 2 同 侧 出 力 ， 电 机 0 电机 3 反 向 出 力 《Motor[1] 
和 Motor[2] 中 的 Roll 为 - ，Motor[0] 和 Motor[3] 中 的 Roll 为 + ) 

。 Pitch 方 向 旋转 ， 为 了 恢复 平衡 ， 则 电机 2 电机 3 同 侧 出 力 ， 电 机 0 电机 1 反 向 出 力 
(Motor[21] 和 Motor[3] 中 的 Pitch 为 - ，Motor[0] 和 Motor[1] 中 的 Pitch 为 + ) 

e YawW 方 同族 转 ， 为 了 恢复 平衡 ， 则 电机 1 电机 3 同 侧 出 力 ， 电 机 0 电机 2 反 向 出 力 ， 
(Motor[1] 和 Motor[3] 中 的 Yaw 为 + ，Motor[0] 和 Motor[2] 中 的 Yaw 为 - ) 


本 篇 内 容 ， 部 分 来 目 Nemo 之 家 博客 四 轴 PID 讲 解 。 


气压 计 MS5611 


作者 : nieyong 
Crazepony 使 用 气压 计 (或 者 叫 高 度 计 ) MS5611。 


MS5611 气 不 传感器 是 由 MEAS (瑞士 ) 推出 的 SPI 和 Il2C 总 线 接口 的 新 一 代 高 分 辩 率 气压 传 感 
器 ， 分 状 率 可 达到 10cm。 我 们 使 用 的 Il2C 接 口 ， 挂 在 MPU5060 的 从 I2C 接 口上 。MS5611 有 2 
种 型 号 的 封装 MS5611-01 BA03( 金 属 封 装 ) 和 MS5611-01BA01( 塑 壳 封 装 ) ， 我 们 使 用 的 金属 


封 沪 。 





MS5611 的 12C 地 址 为 0b111011Cx， 其 中 C 比 特 位 由 CSB 引 脚 决定 ， 为 CSB 引 脚 的 补 码 值 〈 取 
反 ) 。Crazepony 上 MS5611 的 CSB 引 上 脚 接 地 ， 所 以 CSB 引 上 脚 值 为 0，8 位 I|2C 地 址 为 
0b1110111x (0xEE) ，7 位 12C 地 址 为 0b1110111 (0x77) 。 


Vec3.3 
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MS5611 的 12C 操 作 命 兮 


下 面 以 Il2C 连 接 模 式 讲 解 ， 符 合 Crazepony 人 硬件 上 的 连接 。 对 MS5611 心 片 操 作 ， 只 有 5 个 命 


全 
To 


。 复位 心 片 


复位 MS5611 心 片 ， 守 入 一 个 字 节 0x1E 即 可 。 


IICwriteOneByte( ms5611iAddress, Ox1E); // Reset Device 


。 读 取 PROM 中 的 值 


MS5611 气 压 传 感 器 在 出 厂 的 时 候 ， 将 该 片 IC 对 应 的 6 个 系数 宇 在 了 内 部 寄存 器 (PROM) 
中 ， 读 取 该 系 效 ， 用 于 后 面 对 实 际 温 度 和 实际 气压 的 计算 。 


内 部 寄存 器 的 位 置 分 别 为 0XA2/0xA4/0xA6/0xA8/0xAA/0xAC/0xAE， 只 需要 对 该 位 置 读 取 2 个 


字 节 则 可 。 


IICreadBytes( ms5611iAddress, OxA2, 2, data); // Read Calibration Data C1 
ci.bytes[1] = data[0]; 
ci.bytes[0|] = data[1]; 


IICreadBytes( ms5611iAddress, OxA4, 2, data); // Read Calibration Data C2 
c2.bytes[1] = data[0]; 
c2.bytes[0] = data[1]; 
IICreadBytes( ms5611iAddress, OxA6, 2, data); // Read Calibration Data C3 
c3.bytes[1] = data[0]; 
c3.bytes[0] = data[1]; 
IICreadBytes( ms5611iAddress, OxA8, 2, data); // Read Calibration Data C4 
c4.bytes[1] = data[0]; 
c4.bytes[0|] = datal[1]; 
IICreadBytes( ms5611iAddress, OxAA, 2, data); // Read Calibration Data C5 
c5.bytes[1] = data[0]; 
c5.bytes[0] = data[1]; 
IICreadBytes( ms5611iAddress, OxAC, 2, data); // Read Calibration Data C6 
c6.bytes[1] = data[0]; 
c6.bytes[0|] = datal[1]; 


。 配 午 进行 D1 转化 


D1 转 化 即 气压 转化 ， 告 知 IC 进 行 气压 转化 ， 下 一 步 束 可 以 读 取 气 压 值 《24 位 ) 。 如 果 OSR 为 
4096， 则 与 人 0x48 邱 可 。 


IICwriteOneByte( ms5611iAddress, Ox48); 


。 配 秆 进行 D2 转化 


D2 转化 即 温 度 转化 ， 告 知 IC 进 行 温 度 转化 ， 下 一 步 束 可 以 读 取 温 度 值 (24 位 ) 。 如 有 果 OSR 为 
4096， 则 写 和 人 0x58 即 可 。 


IICwriteOneByte( ms5611Address，0x58 ) ; 


e 读 取 ADC 的 值 


ADC 值 即 上 面 进 行 的 D1 转 化 或 者 D2 转 化 ， 为 24 位 数值 。 对 0x00 读 取 3 个 字 节 即 可 。 


IICreadBytes( ms5611Address，0x00，3，data ) ; // Request temperature read 


上 面 这 5 个 命 合 ， 是 对 ms5611 操 作 的 所 有 命 合 了 。 我 们 可 以 获得 6 个 系数 (只 需要 在 初始 化 时 
凌 取 一 运 即 可 ) ， 然 后 就 是 舍 感 咒 测 量 到 的 温度 数值 和 气压 数值 。 下 面 就 是 要 对 读 到 的 气压 
值 和 温度 值 进行 计算 ， 获 得 真实 的 气压 (帕斯卡 ) 和 温度 (摄氏度 ) 。 


温度 和 气压 的 计算 
首先 看 ms5611 出 厂 时 已 经 确定 的 6 个 系数 : 


。c1， 气 不 敏 感度 ，SENS 

e。 Cc2， 气 压 偏 产值 ，OFF 

e。 Cc3， 和 气压 敏感 度 的 温度 系数 ， 简写 为 TCS 
。 c4， 气 压 偏 差 值 的 温度 系数 ， 简 写 为 TCO 
。 C5， 参 考 温度 ，Tref 

e。 c6， 温 度 系 数 ，TEMPSENS 


上 面 6 个 系数 为 出 厂 时 已 经 人 确定， 为 16 位 数值 。 不 同 的 MS5611 心 片 会 不 相同 ， 但 是 同一 片 心 
片 是 固定 的 ， 只 需要 在 初始 化 时 读 取 一 表 ， 用 于 后 面 的 计算 。 


进行 D1 和 D2 和 转化， 获得 气压 数 值 d1 和 温度 数值 d2， 为 24 位 数值 。 
得 到 了 上 面 8 个 值 之 后 ， 融 可 以 计算 当前 的 实际 温度 和 实际 气压 了 。 计 算 过 程 如 下 。 


Read digital pressure and temperature data 


Digital pressure Value unsigned int 32 医 > 到 国 16777216 9085466 
Digital temperature value unsigned int 32 24| 0 | 16777216 8569150 


Calculate temperature 


Difference between actual Ry reference temperature 玫 signed int 32 .16776960 16777216 
dT =D2-Trec= D2 -C5* 2 


Actual temperature (-40...85°C with 0.01°C gapped 


signed int 32 
TEMP =20°C +dT*TEMPSENS=2000+dT *C6 /2 


Calculate temperature compensated pressure 


Offset at actual temperature 日 
OFF =OFF ehh dT = C2 *2164 (C4*dT)127 signed int 64 -8589672450 12884705280 2420281617 
一 a 一 
Sensitivity at actual temperature 外 
ae an , ri a jC3 *dT)123 signed int 64 -4294836225 6442352640 1315097036 
一 人 一 


Temperature compensated pressure (10...1200mbar with 100009 
0.01mbar resolution) signed int 32 58 1000 120000 
P =D1*SENS-OFF=(D1*SENS/2 -OFF)/2™ = 1000.09 mbar 


Display pressure and temperature value 





二 人 阶 温 度 补偿 


不 同 温 度 对 大 气压 强 测 量 有 着 很 大 影响 ，MS5611 手 册 提 供 有 二 阶 温度 补偿 的 方法 。 如 果 温 度 
低 于 20 摄 氏 度 ， 则 进行 二 阶 温度 补偿 。 


SECOND ORDER TEMPERATURE COMPENSATION 


Low temperature High temperature 


T2=dT /I T=0 
OFF2= 5 .(TEMP - 20007 /2 OFF2= 0 
SENS2= 5. [TEMP 一 20007/ 2 SENS2=0 





Very low temperature 





OFF2 = OFF2 + 7 . (TENMP + 1500Y 
SENS2 = SENS2 + 11 . (TEMP + 1500Y1 2 


Calculate pressure and temperature 


TEN 和 三 TEN 和 PP - T2 
OFF = OFF = OFF2 
SENS = SENS - SENS? 





扩展 -气压 计 的 应 用 
智能 手机 


气压 传感器 首次 在 智能 手机 上 使 用 是 在 Galaxy Nexus 上 ， 而 之 后 推出 的 一 些 Android 旗 舰 手机 
里 也 包含 了 这 一 传感器 ， 像 GalaxySlll、GalaxyNote2 和 小 米 2 手 机 上 也 都 有 。 


登山 测 高 


对 于 喜欢 登山 的 人 来 说 ， 都 会 非 弟 关心 目 己 所 处 的 高 度 。 海 拔高 度 的 测量 方法 ， 一 般 弟 用 的 
有 2 种 方式 ， 一 是 通过 GPS 全 球 定位 系统 ， 二 是 通过 测 出 大 气压 ， 然 后 根据 气压 值 计算 出 海 拟 


高 度 。 


导航 辅助 


现在 不 少 开 车 人 士 会 用 手机 来 进行 导航 ， 不 过 常常 会 有 人 抱怨 在 高 架 桥 里 导航 常常 会 

错 ”。 上 比如 在 高 架 桥 上 时 ，GPS 说 右 转 ， 而 实际 上 右边 根本 没有 右 转 出 口 ， 这 主要 是 GPS 无 
法 判断 你 是 桥 上 还 是 桥 下 而 造成 的 错误 导航 。 一 般 高 架 桥 上 下 两 层 的 高 度 都 会 有 几米 到 十 几 
米 的 距离 了 ， 而 GPS 的 误差 可 能 会 有 几 十 米 ， 所 以 发 生 上 面 的 事情 也 束 可 以 理解 了 。 

而 如 果 手 机 里 增加 一 个 气压 传感器 就 不 一 样 了 ， 他 的 精度 可 以 做 到 1 米 的 误差 ， 这 样 就 可 以 很 
好 的 辅助 GPS 来 测量 出 所 处 的 高 度 ， 错 误导 航 的 问题 也 束 容 易 解决 了 。 

室内 定位 

由 于 在 室内 无 法 很 好 的 接收 GPS 信 号 ， 所 以 当 使 用 者 进入 一 幢 很 厚 的 楼 宇 时 ， 内 置 感应 器 可 
能 会 失去 卫星 的 信号 ， 所 以 无 法 识别 用 户 的 地 理 位 置 ， 并 上 且 无 法 感知 垂直 高 度 。 而 如 果 手 机 


加 上 气压 传感器 再 配 合 加 速 计 、 陀 蝶 仪 等 扩 术 整 可 以 做 到 精准 的 室内 定位 。 这 样 以 后 你 在 丙 
场 购 物 时 ， 束 可 以 通过 手机 定位 来 告诉 你 你 想 购 买 的 产品 在 两 场 的 那个 位 置 ， 哪 一 层 楼 。 


四 


渔 3 


4 


另外 气压 传感器 还 可 以 为 钓鱼 爱好 者 提供 相关 信息 〈 鱼 在 水 中 分 层 及 活跃 性 与 大 气压 相关 ) 
或 天 气 预 报 等 功能 。 


不 过 目前 气压 传感器 还 处 于 一 个 航 忽略 的 状态 ， 气 压 传 感 器 要 想 航 更 多 人 了 解 和 使 用 还 需要 
一 些 相关 技术 的 成 熟 和 普及 ， 以 及 更 多 的 开发 者 针对 这 一 传感器 推出 更 多 的 应 用 和 相关 功 


公 口 
月 Co 


Crazepony 开 源 四 轴 飞 行 赴 


博文 精 选 


这 里 精 选 了 部 分 发 表 在 Crazepony 博 客 上 的 文章 ， 可 以 从 更 多 的 层面 了 解 我 们 的 开发 历程 和 其 
中 的 故事 。 





博文 精 编 202 


Carmack 平 方 根 男 数 经 典 架 例 


作者 : nieyong 


编者 注 : 在 Crazepony 飞 控 代 码 姿 态 解 算 融 合 中 ， 有 一 个 只 有 短 短 不 到 十 行 的 范 数 ， 求 
解 平方 根 的 倒数 。 es ten i 拥有 极 高 的 运算 效率 ， 堪 
称 经 典 。 本 文 融 介绍 该 函数 育 后 的 故事 ， 由 Craze 团 队 -nieyong 整 理 编辑 。 


目 先 粘 贴 Crazepony 飞 控 代 码 IMUS03.c 文件 中 的 该 落 数 ， 求 一 个 浮 点 数 的 平方 根 的 倒数 。 


static float invSqrt(float number) 


volatile long 工 ; 

volatile float x, y; 

volatile const float f = 1.5F; 
x = number ”0.5F， 

y = number ， 

De oe 

i = Ox5f375a86 - ( i >> 1 ); 
y= * (( float * ) &1); 

YY (XY 
return y; 


Quake-lll Arena 《〈 雷 利之 锤 3) 是 90 年 代 的 经 典 游戏 之 一 。 该 系列 的 游戏 不 但 画面 和 内 容 不 

错 ， 而 且 即 使 计算 机 配置 低 ， 也 能 极其 流畅 地 运行 。 这 要 为 功 于 它 3D 引 擎 的 开发 者 约 输 - 卡 马 

(John Carmack) 。 事 实 上 早 在 90 年 代 初 DOS 时 代 ， 只 要 能 在 PC 上 搞 个 小 动画 都 能 让 人 
京 叹 一 番 的 时 候 ，John Carmack 就 推出 了 石破天惊 的 Castle Wolfstein, 然后 再 接 再 励 ， 

i doom-ll, Quake... 每 次 都 把 3D 技 术 推 到 极致 。 他 的 3D 引 擎 代码 极度 高 效 ， 几 乎 是 在 太 
榨 PC 机 的 每 条 运算 指令 。 当 初 微 软 的 Direct3D 也 得 听取 他 的 意见 ， 修 改 了 不 少 API。 


最 近 ，Quake 的 开发 两 ID SOFTWARE 壮 守 GPL 协 议 ， 公 开 了 Quake- 咱 的 原 代 码 ， 让 世人 有 
科目 睹 Carmack 传 奇 的 3D 引 擎 的 原 码 。 


我 们 知道 ， 越 医 层 的 葬 数 ， 调 用 越 频 繁 。3D5 引 和 擎 注 根 到 医 还 是 数学 运算 。 an 
数学 运算 画 数 (在 game/code/q_math.c ) ， 必 然 是 精心 编 守 的。 里面 有 很 多 有 趣 的 函数 ， 

多 都 爷 人 惊奇 。 在 game/code/q_math.c 里 发 现 了 这 样 一 段 代 码 。 meat 
并 取 倒 ， 经 测试 这 段 代 码 比 (float)(1.0/sqrt(x)) 快 4 倍 。 


float Q rsqrt(float number ) 


long 工 ; 

float x2, y; 

const float threehalfs = 1.5F， 

x2 = number * 0.5F， 

y = number,; 

1i1=* ( long * ) &y; // evil floating point bit level hacking 

i = Ox5f3759df - ( i >> 1 ); // what the fuck? 

y= * ( float * ) &i; 

y=Yy * (threehalfs - ( x2 *y*yYy ) ); // 1st iteration 

// Vy =y* (threehalfs - ( x2 *y*Yy ) ); // 2nd iteration, this can be removed 


#1ifndef Q3_ VM 
#ifdef _ linux _ 
assert( !isnan(y) ); // bk010122 - FPE? 
#endif 
#endif 
returnmy, 


SS | 


沙 数 返回 平方 根 的 倒数 ， 即 1/sqrt(x) ， 这 个 本 数 在 图 像 外 理 中 比 标准 画 数 sqrt(x) 更 有 
用 。 


注意 到 这 个 函数 只 用 了 一 次 二 代 。 编 译 ， 实 验 ， 这 个 酌 效 不 仅 工 作 的 很 好 ， 而 且 比 标准 
的 sqrt() 本 数 快 4 倍 ! 要 知道 ， 编 译 器 自 带 的 画 数 ， 可 是 经 过 严格 仔细 的 汇编 优化 的 啊 ! 这 
个 简洁 的 函数 ， 最 核心 ， 也 是 最 让 人 费解 的 ， 束 是 标注 了 “what the fuck?" 的 一 名 


i = 0x5f3759df - (i >> 1 ): 


册 加 上 y=Yy * ( threehalfs - ( x2 * ”yy ));, 两 句 话 融 完 成 了 开 方 运算 ! 而 且 注 意 到 ， 
核心 那 句 是 定点 移 位 运算 ， 速 度 极 快 ! pr 在 很 多 没有 乘法 指令 的 RISC 结 构 CPU 上 ， 这 样 做 


算法 的 原理 其 实 不 复杂 ,就 是 牛顿 迭代 法 ,用 x-f(x)/f'(x) 来 不 断 的 逼近 f(x)=a 的 根 。 


一 般 的 求 平方 根 都 是 这 么 循环 氨 代 算 的 ， 但 是 卡 马 殉 真 正 牛 B 的 地 方 是 他 选择 了 一 个 律 秘 的 章 
数 0x5f3759df 来 计算 那个 猜测 值 ， 束 是 加 注释 的 那 一 行 ， 那 一 行 算出 的 值 非 弟 接近 1/sqrt(n)， 
这 样 我 们 只 需要 2 次 牛顿 迭代 束 可 以 达到 我 们 所 需要 的 精度 。 好 吧 如 果 这 个 还 不 算 历 害 ， 接 看 
看 。 


普 渡 大 学 的 数学 家 Chris Lomont 看 了 以 后 觉得 有 趣 ， 决 定 要 研究 一 下 卡 马 殉 弄 出 来 的 这 个 猜 
测 值 有 什么 奥秘 。Lomont 也 是 个 牛人 ， 在 精心 研究 之 后 从 理论 上 也 推导 出 一 测 值 ， 
和 卡 马克 的 数字 非常 接近 , 0x5f37642f。Lomont 计 算出 结果 以 后 非常 满意 ， 于 是 拿 自己 计算 出 
的 最 佳 猜测 值 和 卡 马 克 的 神秘 数字 做 比赛 ， 看 看 谁 的 数字 能 够 更 快 更 精 哺 丽 或 和 导 平方 根 。 结 
果 是 卡 马 殉 赢 了 ... 谁 也 不 知道 卡 马 克 是 怎么 找到 这 个 数字 的 。 


最 后 Lomont 怒 了 ， 采 用 暴力 方法 一 个 数字 一 个 数字 斌 过来， 终于 找到 一 个 比 卡 马克 数字 要 好 
上 那么 一 丁点 的 数字 ， 虽 然 实际 上 这 两 个 数字 所 产生 的 结果 非常 近似 ， 这 个 暴力 得 出 的 数字 
是 0x5f375a86。 Crazepony 飞 控 代 码 中 ， 萄 是 使 用 的 这 个 值 。 


Lomont 为 此 写 下 一 篇 论文 ，"Fast Inverse Square Root"。 论 文 下 载 地 址 : 
http://www.math.purdue.edu/~clomont/Math/Papers/2003/InvSqrt.pdf{ 或 者 
http://www.matrix67.com/data/InvSqrt.pdf。 参 考 


大 家 可 以 党 试 在 PC 机 、51、AVR、430、ARM、 上 面 编译 并 实验 ， 惊 评 一 下 它 的 工作 效率 。 


有 则 新 闻 ， 大 意 是 说 Ryszard Sommefeldt 很 久 以 前 看 到 这 段 code， 他 一 看 之 下 惊 为 天 人 ， 想 
要 拜见 这 位 前 韭 高 人 ， 但 是 一 路 退 寻 下 去 却 一 直 找 不 到 人 。 在 大 家 人 退 寻 的 过 程 中 ， 有 人 提 到 
一 份 叫 做 MIT HACKMEM 的 文件 ， 这 是 1970 年 代 的 MIT 强 者 们 做 的 一 些 笔记 (hack memo)， 
大 部 份 是 algorithm， 有 些 code 是 PDP-10 asm 写 的 ， 另 外 有 少数 是 C code (有 人 整理 了 一 份 
列表 )。 


这 个 函数 之 所 以 重要 ， 是 因为 求 平方 根 倒 效 这 个 动作 在 3D 运 算 (向 量 运算 的 部 份 ) 里 面 常 党 
会 用 到 ， 如 果 你 用 最 原始 的 sqrtO0) 然 后 再 倒数 的 话 ， 速 度 比 上 面 的 这 个 版 本 大 概 慢 了 四 倍 吧 。 
当然 ， 在 飞 控 多 旋翼 的 姿态 解 算 中 ， 同 样 涉及 到 很 多 向 量 运 算 ， 需 要 求 平方 根 倒数 ， 所 以 我 
们 Crazepony 选 用 了 这 样 一 个 经 典 的 落 数 。 数 学 ， 算 法 是 软件 的 根基 ， 无 论 是 对 于 游戏 3D 引 
擎 还 是 无 人 机 多 旋翼 飞 控 ， 都 是 相通 的 。Carmack 平 方 根 芳 数 就 是 很 好 的 证 明 。 
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编者 注 : Crazepony 微 型 四 轴 飞 行 器 机 身 轮 万 使 用 了 余弦 双 曲 线 ， 有 关 更 加 优美 的 流 线 
型 和 科技 感 。 这 里 总 结 了 一 些 关 于 双 曲 函数 ， 双 曲线 的 故事 和 特征 ， 让 你 更 加 了 解 这 个 
优雅 而 重要 的 数学 函数 。 下 面 的 文章 来 自 知 乎 专栏 文章 《可 能 是 最 好 的 讲解 双 曲 函数 的 
文章 》， 稍 有 修改 和 删 减 。 


你 
可 
能 


和 


通 
的 
双 
曲 
也 
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一 、 发 展 历史 


双 曲 函数 的 起 源 是 荐 链 线 ， 首 先 提出 是 链 线形 状 问题 的 人 是 达 分 奇 。 他 绘制 《把 银 有 狠 的 女 
人 》 时 鲁 仔 细 思 索 女 人 脖子 上 的 黑色 项 链 的 形状 ， 遗 憾 的 是 他 没有 得 到 答 宁 束 去 世 了 。 


时 隔 170 年 之 久 ， 著 名 的 雅 各 布 . 伯 努 利 在 一 篇 论文 中 又 提出 了 这 个 问题 ， 并 且 试 图 去 证 明 这 
是 一 条 抛物 线 。 事 实 上 ， 在 他 之 前 的 伽利略 和 吉 拉 尔 都 猜测 链条 的 曲线 是 抛物 线 。 


一 年 之 后 ， 收 各 布 的 证 明之 无 进展 (废话 ， 证 明 错 的 东西 怎么 会 有 进展 ) 。 而 他 的 弟弟 约翰 : 
伯 努 利 却 解 出 了 正确 答案 ， 同 一 时 期 的 莱 布 尼 欧 也 正确 的 给 出 了 县 链 线 的 方程 。 他 们 的 方法 
都 是 利用 微 积 分 ， 根 据 物 理 规 律 给 出 悬 链 线 的 二 次 微分 方程 然后 册 求 解 。 


18 世 纪 ， 约 翰 : 兰 伯 特 开始 研究 这 个 范 数 ， 首 次 将 双 曲 函数 引入 三 角 学 ; 19 世 纪 中 后 期 ， 奥 古 
斯 都 : 德 : 摩 根 籽 圆 三 角 学 扩展 到 了 双 曲 线 ， 威 廉 :克利 往 德 则 使 用 双 曲 角 参 数 化 单位 双 曲 线 。 至 
此 ， 双 曲 函 数 在 数学 上 已 经 占有 了 举足轻重 的 地 位 。 


19 世 纪 有 一 门 学 科 开 始 了 全 面 发 展 复 变 函数 。 伴 随 着 欧 拉 公 式 的 诞生 ， 双 曲 函 数 与 三 角 
葬 数 这 两 类 看 起 来 截然 不 同 的 函数 获得 了 前 所 未 有 的 统一 。 








在 实 域 内 ， 三 角 琅 数 的 值 是 通过 单位 贺 和 角 终 边 上 三 角 事 数 线 的 长 度 定 义 的 。 当 然 这 个 [长 
度 」 是 有 正 负 的 。 


同 理 ， 双 曲 函 数 的 值 也 是 通过 双 曲 线 和 角 终 边 上 的 双 曲 函数 线 的 长 度 定义 的 。 如 图 : 


cysh 


sinh 





nl 
-Nversinh 
i 1 

I 


i 十 
atl , 1 
本 
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具体 的 定义 为 


tanhxr = — 


三 、 阔 数 性 质 


和 对 应 的 三 角 函 数 性 质 十 分 类 似 ， 但 又 有 一 定 的 区 别 。 











| 函 野 的 性 质 
引 :其 定名 域 为 : fm,+amy ; 
观 曲 正 | a —e SI 
| b) : 是 党 图 烙 ， 
让) 准 定 义 域内 是 单调 增 
a) :其 定 灸 域 为 :1% +w1)， 
再 曲 杂 a" ee z z 
| | b) : 是 偶 画 糙 ， 
c) : 其 图 像 过 点 (0,1). 
a 引 :其 定 灸 域 为 : [+ ) 
bY 是 育 画 粮 ， 
观 曲 正 | 1 a 
| hx = 一 一 .Cc) 洪 图 形 束 在 水 平 直 总 
切 
y=1 及 y=-1 之 间 ; 在 定 
域内 单调 增 : 


四 、 恒 等 式 


双 曲 沙 数 恒等式 一 定 要 结合 大 三角 图 数 恒等式 一 起 看 ， 真 的 是 太 像 了 : 


Crazepony 开 汤 四 轴 飞 行 奇 


圆 琅 数 (三 角 函 数 ) 双 曲 阔 数 




















1. 基 本 性 质 ， 1 .基本 性 故 ， 
sn x COSX shx Ch x 
tan x = cotx=C— thx = ,tn 
COS S11 区 eh x sh x 
SECX=——— ,CICX=— sech x = CSCh x =— 
COSX Sin x ch x sh x 
tan Cot x = 1 thxethx=] 
sin xcescx=1] sh xcschx=] 
SEC XCOSX= 1] sechxchx=1] 
sin x+cos- x=] ch x—-sh*x=] 
[+tan x=sec x ,1+cot x=Cse x 1-th x=sech x,1—ecth x=—esch x 
2. 苛 傈 性 : 2. 奇 贷 性 ; 
sin(—x)=—sn x sh(—x)}=—shx 
cos(=X) 三 COSX ech(=x) = eh x 
tan(—x)=— tanx th(—x)=—thx 
3. 两 人 朋 和 闭 们 式 3. 两 骨 和 着 公式 
sin(x+ty)= Snxcos y+tcosxsiny sh(x+y)=shxchytchxshy 
COS(x+t y)=cosxcos vy SInxSsiny ch(x+y)=cehxchv+shxshy 
tanx+ttany thx+tthvy 
tanlyY 土 了 = 一 一 一 也 (xx 土 由) = 一 一 一 
ltanxtany li+thxthy 
和 4. 二 售 骨 公式 4. 二 倍 东 合式 
SiN 2x = 28IN XCOSX sh2x=2shxehx 
COS YT = COS 三 一 Sn x ch2x=ceh xi+sh x 
-2cos x—] =2ch x—l 
=]—2sin’ x =1+2sh x 
2 tan x 2thx 
tan 7 = 一 一 一 一 t= 
1l—tan x 1 + th™ x 


五 、 欧 拉 公 式 
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网 拉 公 式 是 复 变 琅 数 里 几乎 最 重要 的 一 个 公式 ， 它 揭示 了 三 角 加 数 和 指数 玉 数 之 间 的 内 在 联 
系 ， 从 形式 上 也 十 分 简洁 优 和 : 


CES 3 — 151]11 了 
用 -x 蔡 换 近 X， 得 到 
六 TH zi]l 


这 样 我 们 可 以 解 出 正弦 和 余 终 函数 与 指数 本 数 的 天 系 卫 : 


CTE™ 1 - 
沁 


再 把 双 曲 范 效 拉 过 来 看 看 





s11h a 


是 不 是 非常 接近 了 呢 ?很 容易 看 出 它们 之 间 存 在 这 样 的 关系 : 


- | . Ca 
双 曲 函数 和 三 角 本 数 的 区 别 信 仅 在 于 是 否 有 -1 的 千 这 一 项 ， 双 曲 男 数 就 是 将 三 角 画 数 改 为 非 交 
错 级 数 。 正 是 由 于 其 无 比 相似 的 级 数 展开 ， 才 使 得 它们 具有 十 分 相似 的 性 质 。 


我 们 说 了 这 人 么 多 ， 两 类 酌 数 似乎 各 种 相似 却 还 是 不 一 样 。 那 么 三 角 男 效 和 双 曲 函 效 的 关系 到 
底 是 什么 呢 ? 


在 复 域 上 ， 它 们 的 形状 其 实 是 一 样 的 | 
不 信 ?我 们 画 一 画图 像 。 





WW 请 中 向 和 梓 于 





这 两 个 式 子 说 明 对 应 的 两 个 加 数 仅 通过 旋转 (对 于 复 变 琅 数 ， 乘 i 束 相 当 于 逆 时 针 旋 转 90°) 即 
可 曹 合 。 


对 了 ， 大 家 都 知道 三 角 函 数 的 周期 是 2pi， 那 么 大 家 猜 猜 双 曲 函数 的 周期 是 多 少 ? 没 错 ， 是 
2ipi | 


七 、 映 射 天 系 


需 具 各 复 交 阔 数 基础 ， 该 部 分 省 上 略 .…..….. 


八 、 应 用 泄 围 


1. 蕉 链 线 


着 链 线 的 方程 是 双 曲 余弦 事 数 ， 这 个 在 文章 开头 已 经 介绍 过 。 而 基 索 桥 、 双 曲 拱 桥 、 染 空 电 
绕 等 都 用 到 了 姑 链 线 的 原理 。 在 工程 上 ， 定 义 a 为 县 链 线 系数 ， 而 把 县 链 的 方程 记 为 


1 一 PICosD 一 一 二 


给 应 用 带 来 很 大 的 方便 ， 如 图 : 
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Crazepony 办 状 天 线 军 外 飞行 记 


作者 : nieyong 
进入 2015 年 ，Crazepony 终 于 迎 来 了 5.1 版 本 。 为 了 这 一 版 本 ，Craze 团 队 投 入 了 很 大 的 精 
力 ， 人 在 操作 性 能 ， 结 构 组 疙 上 都 有 了 不 少 的 改进 。 昨 天 我 们 匠 控 换 上 了 带 有 PA 的 办 状 天 线 ， 
再 次 来 到 开放 制造 空间 ， 体 验 了 一 把 宇 外 飞行 。 


首先 是 Techspace 的 Logo 特 写 ， 这 是 一 个 深圳 创 客 聚 集 的 福地 。Crazepony 也 多 次 来 到 这 里 ， 
并 且 认 识 了 不 少 这 里 的 小 伙伴 。 





正在 静 静 的 充电 中 。 这 时 候 融 会 问 到 ， 吏 一 次 电 ， 能 够 飞 多 久 呢 ?回答 是 : 我 们 只 能 够 飞 4-5 
分 钟 。 这 已 经 是 Crazepony 的 350mAh 电 池 的 极限 了 。 当 然 ， 你 可 以 目 己 配备 一 块 500mAh 的 
电池 。 很 多 朋友 会 说 ， 我 买 的 司马 X5C 这 样 的 玩具 飞机 ， 能 够 飞 更 久 呢 ， 为 什么 你 们 只 能 够 4 
分 钟 。 你 仔细 看 哦 ，X5C 这 样 的 玩具 飞机 ， 可 是 有 减速 齿轮 的 。 减 速 齿轮 降低 了 电机 的 KV 
值 ， 而 原则 上 低 KV 值 配 大 桨 叶 ， 空 气动 力 效 率 会 高 ， 同 样 的 电池 ， 飞 得 更 久 。 
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室外 飞行 裔 影 。 双 控 器 上 闭 上 了 团 状 天 线 ， 宇 外 飞行 再 也 不 怕 飞 丢 了。 我 们 测试 可 以 飞 80 
米 ， 这 个 时 候 你 基本 上 看 不 到 飞机 了。 使 用 无 关 模 式 (carefree) 飞行 ， 定 是 极 好 的 。 


Crazepony 办 状 天 线 军 外 飞行 记 





加 PA 车 状 天 线 的 听 控 器 及 飞 远 了 的 Crazepony。 冯 控 嚣 上 的 2.4G 部 分 是 以 模块 形式 存在 的 ， 
鹿 接 插 上 鞠 状 天 线 模 块 束 可 以 使 用 ， 无 需 修改 代码 。 我 们 默认 配置 的 不 带 PA 的 2.4G 模 块 ， 可 
于 沁 围 是 10 米 ， 适 合 在 室内 飞行 。 
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一 一 一 


局 其 


再 放 几 张 室 内 飞行 的 靓 照 。 在 最 新 版 本 Crazepony 上 实现 的 无 头 飞 行 模式 ， 气 压 计 Z 轴 定 
变 和 
工区 集 


集 模 式 ， 让 新 手 操控 变 得 简单 。 


Crazepony 开 产 四 轴 飞 行 丁 
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CrazePony 与 计算 机 视觉 


作者 : Ziv.Lin 


大 家 好 ,我 是 CrazePony 的 视觉 攻 城 狮 ,Ziv.Lin, 我 擅长 的 部 分 是 计算 机 视觉 和 姐 人 陈 编 程 ,非常 菏 
幸 地 能 够 加 入 CrazePony 团 队 ~ 


众所周知 ,一 个 飞行 右 想 要 做 到 县 停 的 话 ， 必 须 引 入 一 个 位 置 环 进行 反馈 ， 也 融 是 说 需要 获知 
无 人 机 的 空间 绝对 坐标 ， 目 前 的 无 人 机 普通 采用 GPS (Global Position System) 以 获得 其 位 
置 ， 但 是 GPS 信 号 存在 容易 受 干 扰 (其 至 是 欺骗 ， 伊 妇 截 获 美国 的 RQ170 残 是 采用 GPS 欺 骗 
的 方法 ) 、 在 室内 没有 信号 等 无 法 克服 的 上 弊端， 如今， 业界 正在 寻求 一 种 解决 方案 ， 以 克服 

GPS 的 这 些 先 天 性 的 缺点 ， 也 就 是 我 今天 想 要 说 的 计算 机 视觉 (^^ ) 

对 于 类 似 CrazePony 这 些微 型 飞行 右 来 说 ， 载 重 相 当 有 限 ， 不 大 可 能 机 载 GPS 系 统 (因为 如 

果 想 要 获得 较 低 的 定位 误差 ,必须 使 用 介 电 陶 砍 的 天 线 ， 其 重量 较 重 ) , 想 要 实现 其 停 等 动作 , 比 
较 可 行 的 方法 融 是 引入 视觉 定位 系统 ,如 下 图 所 示 . 






监 牙 把 坐标 
返回 给 飞行 


&@ 


U5B 摄 像 头 









| 


计算 机 处 理 UsB 摄 像 头 获得 的 
视频 帧 序列 ,获得 飞行 露 的 空间 
位 置 





CrazePonzy 的 计算 机 视觉 定位 我 打算 分 为 三 步 走 : 


第 一 步 :就 是 实现 四 轴 飞 行 器 的 视觉 跟踪 ,现在 已 经 初步 完成 ~ 





om demo (正在 运行 ) - Microsoft Visual Studio( 管 理 员 ) [EW | 
4 | CrazePony Vision Demo [Sl | | 轨 Terepony et deme en a x 




















et I 
这 个 视觉 定位 系统 视频 已 经 上 传 至 CrazePony 的 首页 (也 附加 在 本 文 最 后 ) ， 这 个 是 基于 
OpenCV 库 开发 的 一 个 定位 系统 ,其 算法 流程 图 如 下 所 示 : 


46 Ipllmage* 
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”开始 


从 UBH 妇 像 兴 苞 取 10 和 Nib 
上 的 图 像 厅 列 , 用 于 机关 
学 习 痛 景 模型 


| 机 器 学 习 完成 之 
后 , 生成 一 个 背景 
模型 , 存在 系统 内 


存 中 


获取 新 图 像 







一 与 事先 训练 的 背景 模型 进行 比 ” 
、_ 较 , 判断 是 不 是 前 景 






加 


进行 判断 ， 
确定 十 不 十 
CrazePony 飞行器 


关 0 


计算 出 飞行 器 的 从 
” 标 位 置 


通过 无 线 发 送 
飞行 器 坐标 





第 二 步 : 融 是 实现 飞行 器 的 航线 飞行 ,现在 ,我 们 团队 正在 努力 实现 中 
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第 三 部 :把 所 有 的 计算 机 视觉 移植 到 手机 平台 去 ,现在 我 们 已 经 实现 OQpenCV 库 在 Android 上 面 的 
移植 了 ,相信 总 有 一 天 ,你 可 以 使 用 你 的 手机 飞 CrazePony 了 
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最 后 附 上 Crazepony 视 觉 定位 系统 的 优酷 视频 。 
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Crazepony 自 平衡 小 车 


作者 : nieyong 


离 上 次 参加 makeblock 周 末 马 拉 松 比赛 已 经 快 一 个 月 了 。 一 站 想 介 绍 我 们 Craze 团 队 的 作品 基 
于 Crazepony 目 平衡 小 车 ， 却 迟 迟 没有 动笔 。 很 多 人 在 问 为 什么 主页 上 天 于 自 平衡 小 车 的 链 

接 是 空 的 ， 大 家 都 等 不 及 了 。Crazepony 平 台 不 仅仅 是 一 个 四 轴 飞 行 器 ， 而 且 还 能 够 很 简单 的 
实现 目 平衡 小 车 。 

首 务 上 图 。 我 们 使 用 了 makeblock 提 供 的 机 械 构 件 ， 包 括 车 轮 ， 电 机 ， 以 及 一 些 金属 连接 构 


件 。 这 里 不 得 不 先 一 下 makeblock 的 产品 ， 全 部 是 绍 合金 材质 ， 非 常 高 达 上 。 而 且 特 有 的 内 岂 
螺纹 槽 ， 给 DIY 提 供 了 非常 大 的 有 灵活 性 。 基 本 上 在 任何 地 方 都 可 以 上 螺丝 进行 连接 。 
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电机 了 驱动 电路 也 使 用 makeblock 提 供 的 Me Motor Driver 模 块 。Me 系 列 模块 本 来 是 为 降低 
makeblock 电 子 部 分 门槛 而 开发 的 ， 使 用 了 RJ-25 连 接头 。 这 和 Crazepony 飞 控 板 是 不 匹配 
的 ， 所 以 我 们 不 得 不 做 飞 线 处 理 。 





中 电 ， 
中 连 

和 

4] 

W 
路 

PADS 

和 7 

y 

小 是 

上 面 

又 





各 4 
1 





pe - - 
2 ae 
Ws Bh 2 gra 


只 需要 稍稍 修改 飞 控 代 码 〈 主 要 是 PID 参 数 ) ， 我 们 的 目 平衡 小 车 束 能 够 站 立 起 来 了 。 在 比赛 
中 使 用 的 这 个 方案 是 开 环 控制 ， 没 有 小 车 运动 速度 的 反馈 作 闭环 控制 ， 所 以 我 们 的 目 平 衡 小 
车 并 不 能 够 行走 上 自 如。 我 们 让 它 在 一 个 定做 的 “拳击 擂台 ”里 冲撞 。 它 的 对 手 只 有 一 个 ， 那 束 是 
它 上 自己 ， 别 让 目 己 倒 下 啦 。 


最 后 放 上 Crazepony 在 拳击 擂台 里 跌跌撞撞 的 视频 。 
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DIY 四 轴 飞 行 古 如 何人 门 ? 


作者 : 电子 哲人 
作者 : 电子 匠人， 本 文 在 知 乎 同 标题 帖 基 础 上 编辑 而 成 。 


先 回答 入 门 书 籍 的 问题 。 在 淘宝 和 和 泵 东 上 没 见 到 过 DIY 四 轴 的 书籍 ， 有 一 些 飞 行 器 的 也 是 建 模 


伸 马 的 天 书 。 当 时 在 束 示 买 了 一 本 《空中 机 器 人 《四 施 收 ) 专项 教育 教材 》》， 妈 和 绰 这 么 偏僻 
我 都 找到 了 ! 1 ! 工 快递 到 了 兴 局 彩 烈 的 拆 包 ， 全 书 主要 讲 了 空中 机 器 人 大 赛 的 重大 意义 ， 
坑 多 呢 这 是 ! 1 1 | 





四 轴 有 很 多 种 做 法 ， 我 发 一 下 我 知 追 的 两 种 吧 


大 四 轩 


大 四 轴 , 无 刷 电机 + 电 调 + 飞 控 板 (各 种 Geek 长 玩 的 ， 买 硬件 ， 调 参数 和 算法 ) 
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大 四 轴 是 最 烧 钱 的 了 ， 入 手 一 套 大 概 1000~2000 元 。 我 们 是 DIY， 各 种 需 件 当然 要 自己 买 了 ， 
不 怕 折 腾 ， 我 们 按照 如 下 配置 搭建 一 套 大 四 轴 : 


。 格 氏 11.1V2200mA25C 锂 电 128 

e。 B6 充 电器 160 

。 郎 宇 A2212 电 机 62x4 

。 螺旋 浆 8 个 40 (需要 4 个 正 浆 ，4 个 反 浆 ， 万 一 坏 了 呢 剩 下 备用 ) 

e be 48x4 

。 四 轴 机 架 8 

。 飞 控 板 100 en 则 光 调 参数 你 都 不 好 意思 说 出 口 ) 
。 天 地 飞 6 遥 控 器 200 (6 通道 遥控 器 ) 


通道 融 是 可 以 遥控 器 控制 的 动作 路 数 ， 比 如 遥控 回 只 能 控制 四 轴 上 下 飞 ， 那 么 下 是 1 个 通道 。 
但 四 轴 在 控制 过 程 中 需要 控制 的 动作 路 数 有 : 上 下 、 左 右 、 前 后 、 旅 转 所 以 最 低 得 4 通道 陆 控 
器 。 如 果 想 以 后 玩 般 担 这 些 融 需要 更 多 通道 的 遥控 器 了 。 
算 一 下 总 价 : 128+160+624+484+88+200+100=1156 


我 们 把 四 轴 组 疼 起 来 (会 简单 的 电路 焊接 束 可 以 了 ) 融 可 以 连接 上 位 机 通过 电脑 调试 参 效 
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这 个 界面 简 下 狂 搜 酷 柑 吊 炸 天 啊 ! | 


调试 主要 是 PID 参 数 ， 一 般 买 的 飞 控 简单 调调 束 可 以 试飞 了 。 日 后 还 可 以 加 GPS 和 俐 马 的 玩 些 高 
师 的 定点 飞行 ! 

大 四 轴 一 定 要 有 一 个 安全 的 调试 环境 ， 东 西 要 闪 牢 千 ， 周 围 不 要 有 行人 。 还 有 融 是 ! 一 旦 发 
生 问题 干 万 不 要 用 手 去 抓 四 轴 ! 届 (这 个 是 看 到 我 QQ 空间 上 一 个 好 友 调 四 轴 受 伤 的 手 : 





人 “于 
而 
-" & 





看 到 有 些 人 调 四 轴 都 带 护 目镜 保护 眼睛 以 防 螺 旋 奖 断 了 射出 去 ! ! 1 高速 旋转 的 螺旋 桨 就 像 
子弹 一 样 ， 不 要 以 为 是 玩 束 没有 安全 隐患 了 ， 绝 不 要 掉以轻心 ! 


小 四 轴 


作为 属 丝 学 生 和 党， 大 四 轴 我 暂时 是 玩 不 起 的 。 于 是 我 融 想 别 的 办 法 ， 反 正 都 是 四 轴 ， 小 的 是 
不 是 便宜 些 又 安全 些 ? 


小 四 轴 不 仅 没 有 电 调 ， 连 机 殿 都 得了 ， 电 机 委 在 电路 板 上 : 





没有 大 四 轴 飞 起 来 震 气 ， 不 能 载重 。 但 小 四 轴 有 个 优点 束 是 想 飞 束 飞 ， 一 不 受 空间 限制 ， 二 
不 容易 伤 人 。 即 使 你 用 手 抓 螺旋桨 ， 那 感觉 基本 也 融 是 挠 痒痒 。 


小 四 轴 的 配置 和 价格 : 


。 716 空 心 杯 电 机 40 (10*4) 

。 20C 3.7v 锂电 池 15 (和 与 手机 电池 区 别 在 放电 量 上 ) 
。 一 大 堆 电 子 器 件 50 

。 PCB 电 路 板 制作 100 

。 蓝牙 模块 30 

。 遥控 器 用 安 齐 手机 不 花 钱 


计算 下 40+15+50+100+30 = 245 元 ， 相 比较 大 四 轴 的 1156 来 说 少 了 太 多 
小 四 轴 的 优点 : 


。 价格 便宜 

。 从 口 安里 掏 出 来 焉 能 

。 目 己 设计 飞 控 电 路 板 

。 目 己 移植 编写 开源 单片机 程序 


Crazepony 开 源 四 轴 飞 行 赴 


。 手机 遥控 连 遥 控 句 都 省 了 


小 四 轴 价 格 便宜 ， 飞 行 灵活 ， 还 能 体会 到 完整 的 DIY 乐 趣 。 下 面 是 我 自己 DIY 的 四 轴 飞 行 器 
〈( 飞 皖 ，PC 上 位 机 ， 手 机 遥控 ， 摇 杆 ) 





我 的 四 轴 有 个 小 机 染 ( 碳 杆 + 空 心 杯 电机 + 减速 齿轮 ) 也 不 贵 ， 几 十 块 钱 。 


现在 看 到 越 来 越 多 的 人 都 开始 玩 小 四 轴 了， 我 的 四 轴 束 是 根据 论坛 的 开源 四 轴 一 步 步 制 作 
的 。 


分 享 几 个 开源 四 轴 的 资料 : 
国外 的 : 








e Crazyflie : E 
e 德国 MK : MikroKopter 


国内 的 : 
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回答 越 写 越 长 ， 不 知 不 觉 写 了 俩 小 时 ， 最 后 希望 大 家 早日 DIY 出 目 己 的 四 轴 飞 行 器 ! 
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《大 人 的 科学 》 引 起 的 思考 


作者 : nieyong / Jul 07,2014 

《大 人 的 科学 》 是 日 本 的 一 本 科技 类 的 季度 杂志 。 每 期 介绍 一 个 科学 模型 ， 并 附送 这 个 科学 
模型 ， 让 读者 DIY 这 个 产品 ， 并 从 中 感受 到 制作 的 快乐 ， 并 学 到 相应 的 科学 知识 。 例 如 第 一 期 
是 关于 蒸汽 汽 租 ， 第 九 期 是 DIY 星 象 仪 模 型 。 这 本 杀 志 在 日 本 非常 受 欢迎 ， 取 得 了 很 大 的 成 
功 。 


“科学 的 世界 无 天 年 龄 ， 有 趣 的 事物 始终 有 趣 " 这 是 该 条 记 的 口号 。 





和 





我 是 通过 科学 出 版 社 的 主编 Lee 知 道 这 本 杂志 的 。 出 版 社 对 我 们 的 四 轴 飞 行 器 感 兴趣 ， 束 是 想 
借鉴 《大 人 的 科学 》 的 模式 ， 做 一 期 四 轴 飞 行 器 的 刊物 。 

结合 目 己 刁 处 电子 行业 ， 对 开源 硬件 / 创 客 的 了 解 ， 我 觉得 手工 DIY 制 作 套 件 这 个 领域 ， 有 很 
大 的 挖 气 前景。 这 既是 一 件 非常 有 意义 的 事情 ， 又 能 够 找到 适合 目 己 生存 的 土壤 《大 人 的 
科学 》 是 一 个 很 好 的 模式 和 案例 ， 这 个 市 场 在 中 国 现在 还 比较 空 日 。 对 原来 粗糙 的 手工 制作 
进行 重新 定位 和 思考 ， 使 用 我 们 现在 的 理念 来 包装， 运营 ， 销 售 。 


下 图 就 是 做 好 的 星象 仪 效 果 图 。 





Crazyflie 四 轴 飞 行 页 


Crazyflie 四 轴 飞 行 器 是 一 个 和 Crazepony 非 党 类 似 的 迷你 四 轴 飞 行 器 项 目 ， 由 瑞士 三 个 工程 渍 
设计 开发 。 该 项 目 现 在 由 深圳 Seeed Studio 公 司 负 责 生 产 和 销售。Crazyflie 是 Crazepony 的 前 
非 和 学 习 的 对 象 。 


我 们 研究 了 Crazyflie 的 结构 /人 硬件/ 软件， 并且 做 了 相关 的 笔记 和 分 析 。 这 里 我 们 将 笔记 分 享 出 
来 ， 方 便 后 面 人 们 的 研究 和 学 习 。 





FreeRTOS 简介 


FreeRTOS 


在 铭 入 式 领域 中 ， 散 入 式 实 时 操作 系统 正 得 到 越 来 越 广泛 的 应 用 。 采 用 馈 入 式 实时 操作 系统 
(RTOS) 可 以 更 合理 、 更 有 效 地 利用 CPU 的 资源 ， 简 化 应 用 软件 的 设计 ， 缩 短 系统 开发 时 间 ， 
更 好 地 保证 系统 的 实时 性 和 可 靠 性 。 


作为 一 个 轻 量 级 的 操作 系统 ，FreeRTOS 提 供 的 功能 包括 : 任务 管理 、 时 间 管 理 、 信 号 量 、 消 
息 队 列 、 内 存 管 理 、 记 录 功 能 等 ， 可 基本 满足 较 小 系统 的 需要 。FreeRTOS 内 核 支 持 优 先 级 调 
度 算法 ， 每 个 任务 可 根据 重要 程度 的 不 同 被 赋予 一 定 的 优先 级 ，CPU 总 是 让 处 于 束 绪 态 的 、 
优先 级 最 高 的 任务 先 运 行 。FreeRT0S 内 核 同 时 支持 轮换 调度 算法 ， 系 统 人 允许 不 同 的 任务 使 用 
相同 的 优先 级 ， 在 没有 更 高 优先 级 任务 束 绪 的 情况 下 ， 同 一 优先 级 的 任务 共享 CPU 的 使 用 时 
间 。 


FreeRTOS 的 内 核 可 根据 用 户 需要 设置 为 可 剥夺 型 内 核 或 不 可 剥夺 型 内 核 。 当 FreeRTOS 被 设 
置 为 可 剥夺 型 内 核 时 ， 久 于 融 绪 态 的 高 优先 级 任务 能 剥夺 低 优 先 级 任务 的 CPU 使 用 权 ， 这 样 
可 保证 系统 满足 实时 性 的 要 求 ; 当 FreeRTOS 被 设置 为 不 可 剥夺 型 内 核 时 ， 人 处 于 束 绪 态 的 高 优 
先 级 任务 只 有 等 当前 运行 任务 主动 释放 CPU 的 使 用 权 后 才能 获得 运行 ， 这 样 可 提高 CPU 的 运 
行 效率 . 


Crazepony-ll 的 FreeRTOS 移 植 


目前 稳定 的 裸 机 程序 已 暴露 出 很 多 疾 端 ,比如 CPU 资 源 浪费 问题 ,处 理 任务 单一 ,只 能 是 中 断 启 
套 或 者 CPU 轮 询 机 制 去 处 理 各 类 事件 ,CPU 空 挡 期 远大 于 实际 利用 期 . 


所 以 ,目前 我 们 正 专 人 负责 移植 FreeRTOS 系 统 ,在 系统 层面 做 到 兼容 Bitcraze 的 crazefile 固 件 ， 
在 这 期 间 肯 定 会 遇 到 很 多 问题 ,这 都 需要 大 家 在 实际 体验 过 程 中 发 现 并 解决 问题 ,在 Crazepony 
这 个 平台 更 加 稳定 ,更 加 成 熟 


在 Crazyflie 的 固件 代码 中 ， 安 一 般 都 定义 在 文件 Makefile 中 。 使 用 cFLAss += -D 的 方式 添加 。 


# Flag that can be added to config.mk 


CFLAGS += -DUSE UART_CRTP # Set CRTP link to UART 
CFLAGS += -DUSE ESKYLINK # Set CRTP link to E-SKY receiver 
CFLAGS += -DENABLE UART # To enable the uart 


CFLAGS += -DDEBUG PRINT_ ON_ UART # Redirect the console output to the UART 


ENABLE UART 


启用 串口 打印 功能 。 要 想 调试 期 间 把 信息 打印 到 串口 ， 还 需要 加 上 
DEBUG PRINT_ON UART 


济 


USE UART CRITP 


crtp 模 块 为 : Crazy Realtime Transfer Protocol stack， 是 crazy flie 的 通信 协议 栈 。 通 信 链 路 
可 以 2.4G 遥控 信息 ， 可 以 使 用 USE_ESKYLINK， 也 可 以 使 用 串口 。 若 要 使 用 蓝牙 模块 作为 
通信 和 链 路 ， 应 该 开启 此 安 。 


DEBUG PRINT ON UART 


使 用 串口 调试 。 在 平衡 算法 当中 进行 调试 的 时 候 ， 串 口 打 印 显 得 尤为 重要 ， 通 过 此 安 可 以 开 
所 串口 调试 。 注 意 : 开启 串口 调试 的 时 候 不 能 开启 宏 USE_UART_CRTP， 串 口 作为 通信 和 链 
接 。 


BOARD 2 


此 宏 在 drivers/i2c gpio.c 文 件 中 。 因 为 版 本 2 与 版 本 3 的 i2c 部 分 引 脚 有 区 别 ， 去 掉 此 安定 义 适 
用 于 第 三 版 的 硬件 


系统 流程 框 碎 


作者 : nieyong 
介绍 系统 的 初始 化 流程 ， 以 及 系统 任务 之 间 的 关系 。 


系统 任务 


最 关心 的 是 系统 中 由 多 少 个 任务 在 运行 。 在 FreeRTOS 下 ， 任 务 的 初始 化 使 用 函数 。 所 以 ， 用 
grep 命 全 参看 一 下 源 代 码 ， 可 以 看 到 一 共有 下 面 这 些 系统 初始 化 的 任务 : 


$ grep -inIw 'xTaskCreate' -r ./hal/ ./modules/ 

/hal/src/eskylink.c:312: xTaskCreate(eskylinkTask, (const signed char * const)"EskyLink 
/hal/src/pm.c:111: xTaskCreate(pmTask, (const signed char * const)"PWRMGNT", 
/hal/src/uart.c:145: xTaskCreate(uartRxTask, (const signed char * const)"UART-Rx", 
./hal/src/radiolink.c:237: xTaskCreate(radiolinkTask, (const signed char * const)"RadioL 
/Modules/src/stabilizer.c:157: xTaskCreate(stabilizerTask, (const signed char * const)" 
./mMmodules/src/crtp.c:77: xTaskCreate(crtpTxTask, (const signed char * const)"CRTP-Tx", 
./mMmodules/src/crtp.c:79: xTaskCreate(crtpRxTask, (const signed char * const)"CRTP-Rx", 
/modules/src/info.c:68: xTaskCreate(infoTask, (const signed char * const)"Info", 
./Modules/src/log.c:171: xTaskCreate(logTask, (const signed char * const)"1log", 
/modules/src/pidctrl.c:43: xTaskCreate(pidCrtlTask, (const signed char * const)"PIDCrtl 
/Modules/src/param.c.:92: xTaskCreate(paramTask, (const signed char * const)"PARAM", 
./mModules/src/system.c:68: xTaskCreate(systemTask, (const signed char * const)"SYSTEM", 


4 
所 有 的 任务 在 创建 之 后 ， 都 会 进入 while(1) 的 循环 中 ， 也 束 是 任务 一 下 循环 运行 。 





任务 之 间 的 天 系 


nl LL 职 完成 系统 的 控制 呢 。 下 面 使 用 一 个 简 图 进 
行 了 说 明 ， 逻 辑 主线 是 控制 数据 的 传递 


Crazepony 开 源 四 轴 飞 行 赴 


全 : 任务 ， 无 特别 说 明 则 任务 
是 处 于 While(1) 循环 中 




























Roll/Pitch/Yaw 数据 
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通信 部 分 介绍 


作者 : nieyong 


通信 协议 指 的 是 肥 控 问 和 主 控 之 间 交 互 数据 的 封 沪 ， 是 一 种 目 行 约定 的 数据 封 治 格式 。 我 们 


采用 的 是 Crazyflie 项 目 中 定义 的 CRTP 协 议 。 
遥控 靖 和 主 控 之 间 数 据 的 交互 ， 物 理 层 可 以 有 下 面 几 种 方式 : 


全 单 片 2. 4G 无 线 射频 收发 尺 片 ， 通过 SPI 接 口 和 MCU 连 接 
e。 蓝牙 2.1 透 传 模 块 ， 通 过 串口 UART 和 MCU 连 接 
e。 蓝牙 4.0 低 功 耗 BLE 透 传 模块 ， 通 过 串口 UART 和 MCU 连 接 


这 几 种 不 同 的 物理 层 通 信 方 式 在 同一 时 刻 只 能 够 选择 其 中 的 一 种 。 并 且 蓝 牙 2.1 和 蓝牙 BLE 根 


据 安 委 的 透 传 模块 不 一 样 进行 选择 。 





IMU 数据 
和 : 任务 ， 无 特别 说 明 则 任务 
是 钼 于 While(1) 御 环 中 a | 
民 stabilize 生 | 一 
系数 A Ee PWM 





pidCt rl 
Roll/Pitch/Yaw 数据 


param 了 










ee de 


adioLinkfj | UARTT 
: 2.4G 通信 牙牙 2.1/BLE 
: NRF24L01 : 
手机 /平板 电脑 
遥控 器 “| | 


ESky Protocol 


在 上 面 示 意图 的 的 通信 方式 选择 上 ， 最 左边 为 EskyLink， 对 应 使 用 宏 USE ESKYLINK 来 开启 
是 否 选择 该 种 链接 方式 。 
# Make copter firmware to be used with the bootloader, CF controlled with eSky ET61 trans 
$ make clean && make USE_ ESKYLINK=1 CLOAD=1 all 
一 ee | 


所 谓 的 Esky Protocol， 其 实 束 是 ESky 公 司 遥 控 器 使 用 的 通信 协议 。 所 以 如 果 选 用 这 种 通信 和 方 
式 ， 那 么 可 以 使 用 ESky 航 模 公 司 的 遥控 器 进行 控制 。Crazyflie 家 网 文 持 ESKY ET6| Remote 
Control 遥 控 器 。 





关于 ESky 公 司 的 2.4G 遥 控 器 设 各 的 通信 协议 ， 参 考 ArduinoRCLib 项 目 中 的 摘 述 : 


The Esky 2.4 GHz equipment uses the Nordic NRF2401AG in both the transmitter and 
receiver. A compatible alternative to this chip is the NRF24L01+ (which is widely 
avalilable). 


ESky 相 关 协 议 内 容 暂 时 不 研究 。 


串口 


使 用 串口 作为 物理 层 指 的 是 蓝牙 透 传 模块 〈 包 括 蓝牙 2.1 或 者 蓝牙 4.0 BLE 模 块 ) 。 串 口 配置 
为 115200 8N1， 收 发 异步 。 


一 个 可 供 主 控 解 析 的 数据 已 格式 ， 约 下 如 下 : 


| DATA 0 | 


| DATA 31 | 


开始 为 一 个 宇 节 的 关 ， 该 宇 节 中 包括 port 字 7 段 ，reserve 字 7 段 ，channel 宇 段 。 紧 跟着 该 自己 ， 
丈 是 0-31 个 字 节 的 数据 ， 数 据 的 长 度 是 任意 的 。 


节 中 的 port 字 段 用 来 区 分 该 数据 包 的 功能 Bb, 第 见 的 包括 下 面 几 个 


e UXU : Console 
。 0x2 : parameter， 表 示 后 面 的 数据 是 系统 的 参数 
。 0x3 : commander， 操 作 命 分， 控制 飞机 的 飞行 ， 包 括 pitch/yaw/roll 等 


对 于 串口 传输 ， 在 上 面 数 据 包 的 最 前 面 需 要 加 上 两 个 字 节 0xaaaa 的 起 始 数据 ， 在 最 后 加 上 一 
个 字 节 的 checksum 数 据 。 格 式 如 下 : 


7 6 5 3 2 1 0 

| OxAA | 

| OxAA | 

| Port | Res | Chan. | 

| Packet length | 

| DATA 0 | 

| DATA 30 | 

| Cksum | 

| OxAA | OxAA | Header | Length | Data0 | Packet | Cksum | 


注意 ， 紧 跟 在 头 后 面 的 第 一 个 data 字 节 ， 表 示 后 面 数 据 的 长 度 。 


操作 命 分 
加 人 公 旦 、 


操作 命令 是 指 用 于 控制 飞行 器 起 飞 ， 前 后 左右 运动 的 命令 ， 英 文 commander。 操控 命令 是 遥 
控 器 最 基本 ， 也 是 最 常用 的 命令 。 数 据 包 头 中 port 字 段 为 0x3 表 示 操 作 命令 。Crazyflie 操 作 数 
据 格式 约定 如 下 。 


| ROLL | PITCH | YAW |THRUST | 
0 4 8 2 14 bytes 


操作 数据 一 共 14 个 字 节 ， 前 12 个 字 节 分 别 表 示 Roll，Pitch，Yaw 的 值 ， 每 个 值 使 用 4 个 字 节 。 
后 2 个 字 节 表示 Thrust 的 值 ， 使 用 2 个 字 节 。 


所 以 ， 使 用 串口 发 送 的 一 个 操作 命令 示例 如 下 : 


Oxaa Oxaa Ox30 0Xxoe 0Xx00 0X00 0X00 0Xx00 0X00 0Xx00 0Xx00 0X00 0Xx00 0X00 0X00 0X00 0X00 0X00 


4] | 





其 他 


这 里 记录 了 Crazepony 开 发 过 程 中 的 部 分 内 容 ， 例 如 板 形 轮廓 ， 文 件 编码 等 等 。 


Crazepony 开 源 四 轴 飞 行 二 


Crazepony 的 板 形 轮 慷 及 沉 金 工艺 


作者 : 陈 泽 利 ，nieyong 


板 形 轮 万 


目前 ， 市 面 上 的 绝 大 部 分 的 小 四 轴 采 用 的 是 下"X" 形 和 下 "十 " 字 的 结构 。 但 这 两 种 结构 有 一 个 
缺点 ， 融 是 机 角 的 问题 。 如 果 机 名 做 得 太 宽 ， 坚 无 疑问 会 严重 影响 到 整个 小 四 轴 的 美观 性 。 
但 是 如 果 不 做 宽 ， 为 了 给 蝶 旋 桨 让 出 足够 的 空间 ， 机 簿 是 要 伸 出 小 四 轴 主 体 一 段 相对 比较 长 
的 距离 的 ， 这 祥 的 话 融会 霹 成 整个 机 篆 细 长 ， 有 碰撞 或 者 受 力 稍 大 都 可 能 造成 机 名 断 抒 在 
网 上 看 到 不 少 四 轴 爱 好 者 束 把 钨 过 这 个 问题 ) 。 





对 以 上 的 问题 ，Crazepony 在 设计 过 程 中 ， 淘 汰 了 家 "X" 和 址 “十 ? 字 的 结构 。 采 用 了 全 新 的 双 曲 
线 轮廓 (注意 : 机 辟 与 机 辟 之 间 并 不 是 半圆 ) ， 从 小 四 轴 主 体 到 机 臂 末 端 治 一 条 曲线 变 小 ， 
这 样 既 保 证 了 机 筑 的 牢固 性 ， 又 保证 了 整体 的 美观 。 采 用 双 曲 线 结构 之 后 ， 整 机 的 流畅 性 显 
得 淋 注 尽 致 ， 给 人 一 种 柔和 圆滑 的 感觉 ， 与 下 "十 ” 字 的 那 种 采 板 简直 天 天 地 别 。 
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Crazepony 的 双 曲 线 结构 同时 ， 有 别 于 传统 小 四 轴 飞 行 器 PCB 板 结构 的 一 个 地 方 在 于 ， 
Crazepony 在 机 辟 末 端 做 了 一 个 和 电机 外 径 同 等 大 小 的 圆 孔 ， 将 电机 安装 在 圆 孔 内 ， 就 相当 于 
将 电机 栓 在 了 小 四 轴 这 个 整体 上 面 。 这 样 的 方式 与 市 面 上 绝 大 多 数 的 小 四 轴 将 电机 安装 在 
PCB 板 外 的 方式 相 比 有 一 个 很 明显 的 好 处 ， 就 是 : 避免 了 电机 支架 松动 ， 导 致电 机 晃动 ， 从 
而 引起 在 飞行 过 程 中 整体 的 晃动 。 


PCB 板 工艺 


Crazepony 采 用 的 是 黑色 PCB 板 加 沉 金 工艺 。 选 择 黑色 PCB 板 的 主要 原因 束 是 觉得 好 看 ! 搭 
配 上 银色 的 绍 锡 焊 意 之 后 又 显得 有 点 违 和 ， 出 于 对 整体 的 美观 及 进一步 的 工艺 要 求 ， 
Crazepony 在 第 四 版 的 时 候 ， 将 原来 普通 的 银色 铅 锡 焊 瘟 改 为 了 沉 金 工艺 的 金色 焊 盘 。 沉 金工 
艺 的 好 处 在 于 以 下 几 点 : 

。 沉 金 的 金黄 色 配 上 PCB 板 的 黑色 ， 有 森 有 一 种 高 大 上 的 感觉 1! 1 | 

。 在 焊接 时 ， 沉 金工 艺 相对 于 普通 的 铅 锡 焊 盘 更 容易 焊接 ， 不 易 造 成 焊接 不 民 。 

。 沉 金 晶体 结构 致密 ， 不 易 产 生气 化 。 同 时 表面 的 平整 度 与 待 用 寿命 较 好 。 

。 沉 金 板 焊 意 上 只 有 和 镍 金 ， 线 路 上 的 阻 焊 和 与 铜 层 的 结合 更 牢固 。 


想 对 沉 金 工艺 进一步 了 解 的 朋友 可 以 参考 PCB 沉 金工 艺 介绍 。 


源 代码 的 文件 编码 和 文件 格式 


文件 编码 


原则 上 所 有 源 代 码 默 认 使 用 utf-8 编 码 。 


网 站 源码 文件 必须 使 用 utf-8 编 码 。 如 果 使 用 其 它 的 编码 ， 例 如 中 文中 弟 见 的 gdb 格 式 ， 会 导致 
中 文 乱码 ， 或 者 网 页 无 法 生成 的 问题 。 


文件 编码 常识 


Windows 操 作 系 统 默 认 文 件 编码 是 gbk， 又 叫做 gb2312 或 者 cp936。cp936 是 微软 发 布 的 用 在 
文件 系统 中 的 编码 方式 ， 而 gb2313 是 中 国 国 家 标准 ， 又 叫做 ANSI 格 式 编 码 。 例 如 在 
notepad++ 编 辑 器 上 gb2312 编 码 的 文件 惑 显 示 为 ANSI 格 式 编码 ; 使 用 Linux 下 的 flle 命 分， 则 
显示 为 ISO-8859 ; 在 Vim 下 使 用 set fenc? 命 分 查看 ， 则 显示 为 fleencoding=euc-cn。 其 实 这 
三 种 都 是 表示 gb2313 编 码 。 


Linux 操 作 系 统 默 认 文 件 编码 是 utf-8， 一 般 用 系统 宏 $LANG 表 示 。 


$ echo $LANG 
zh_CN.UTF-8 


下 面 几 个 crazepony 固 件 代码 文件 ， 就 是 使 用 的 Windows 下 的 默认 编码 gb2313。 为 了 在 某 些 
工具 下 (例如 gitk 工 具 ) 中 文 不 显示 为 乱码 ， 我 们 要 求 所 有 的 文件 都 使 用 utf-8 编 码 。 但 是 由 于 
我 们 现在 使 用 的 Keil 4 不 支持 utf-8 编 码 ， 所 以 utf-8 编 码 的 中 文 在 Keil 4 下 面 会 显示 为 乱码 ， 所 
以 这 部 分 固件 代码 没有 使 用 utf-8 编 码 。 


$ file User_Src/* 


User_Src/main.c: ISO-8859 C++ program text 
User_Src/Sys_Fun.c: ISO-8859 C program text 
User_Src/Sys_Fun.nh: ISO-8859 C program text 


行 结束 从 问题 


在 Linux/Windows/Mac 下 ， 行 结束 符 不 一 样 。 这 样 在 多 个 平台 之 间 进 行 协作 开发 时 ， 在 
checkin 和 checkout 之 后 ， 会 有 很 多 行 结束 符 不 统一 引起 的 问题 。 


添加 .gitattribute 文 件 ， 可 以 解决 行 结束 符 在 多 个 平台 下 不 一 致 的 问题 。 


# Explicitly declare text files we want to always be normalized and converted 


并 


to native line endings on checkout. 
text 


+ 


# Denote all files that are truly binary and should not be modified. 
*.png binary 


+ 


.jpg binary 


+ 


.gif binary 
*.Jar binary 
*.SO binary 
style/fonts/* binary 
style/images/* binary 


上 面 为 现在 使 用 的 .gitattribute 配 置 ， 解 释 如 下 : 


。 代码 库 中 都 为 LF， 也 束 是 checkin 的 时 候 ， 会 把 所 有 文件 的 行 结 束 符 转 化 为 LF ; 

。 工作 路 径 下 为 所 在 OS 的 行 结 束 符 ， 也 束 是 在 checkout 的 时 候 ，git 回 目 动 根据 当前 的 OS 
将 文件 的 行 结束 符 做 转化 ; 

e。 对 于 图 片 (以 png/jpg/gif 等 结尾 ) ，jar 库 ， 和 so 文件 等 二 进 制 文件 ， 不 进行 转化 ; 


天 于 本 书 
作者 : nieyong 


本 书 《Crazepony 开 源 四 轴 飞 行 器 》 使 用 了 GitBook 管 理 和 发 布 。 是 开源 四 轴 飞 行 器 项 目 
Crazepony 配 套 书 籍 。 


Gitbook 
Gitbook 是 一 个 基于 Node.js 的 命令 行 工具 ， 可 使 用 Github/Git 和 Markdown 来 制作 精美 的 电子 
书 。 


Web 版 本 书籍 调试 命 全 : 

gitbook serve ./ 
在 浏览 器 下 输入 http://0.0.0.0:4000 就 可 以 查看 修改 效果 。 
Web 版 本 书 藉 生成 命 分 : 


gitbook build ./ --output=./outputFolder 


制作 说 明 
《Crazepony 开 源 四 轴 飞 行 器 》 电 子 书 的 内 容 来 自 Crazepony 网 站 百科 wiki， 这 里 只 进行 了 整 
理 和 发 布 ， 给 大 家 提供 在 线 查 看 的 Web 版 本 以 及 可 供 下 载 的 PDF 版 本 。 
Web 版 本 书籍 调试 命 分 : 
gitbook serve ./ 
在 浏览 器 下 输入 http://0.0.0.0:4000 束 可 以 查看 修改 效果 。 
Web 版 本 书 藉 生成 命 分 : 
gitbook build ./ --output=./outputFolder 
在 Crazepony 网 站 的 Book 目 录 下 的 束 是 使 用 该 命 合生 成 的 静态 Web 版 本 书籍 。 


书籍 内 容 来 和 目 Crazepony 网 站 wiki， 我 们 会 定期 将 wiki 的 更 新 同步 到 书籍 中 来 。 虽然 网 站 wiki 和 
gitbook 书 籍 都 是 使 用 markdown 语 言 写成 ， 但 是 还 是 有 部 分 头 文 件 不 相同 。 我 们 专门 宇 了 一 个 
python 脚 本 批量 将 网 站 wiki 的 md 文件 转化 为 适合 gitbook 的 文件 。 进 入 ./wiki 目 录 ， 运 行 : 


./deleteline.py 


版 权 说 明 


《Crazepony 开 源 四 轴 飞 行 器 》 全 部 内 容 以 Creative Commons 署 名 - 非 商 业 性 使 用 -相同 方式 
共 孚 3.0 协 议 发 布 。 任 何 个 人 或 者 组 织 的 商业 用 途 都 是 违法 的 。 


知识 共享 是 一 个 非 营 利 组 织 ， 该 组 织 提供 同名 的 一 系列 奢 作 权 许 可 方式 。 知 识 共 享 组 织 的 主 
要 守则 是 使 得 奢 作 物 肥 更 广 为 流 通 与 改作 ， 作为 其 他 人 据 以 创作 及 共享 的 基础 ， 并 以 所 提供 
的 许可 方式 确保 上 述 理念 。 
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